企业官网建设流程全解析

简介：《悬挂运动控制系统(完整版_原理图及代码)word》面向电子设计竞赛选手、自动化与嵌入式课程学习者，围绕悬挂物精确定位、寻迹与闭环控制给出完整设计方案。文档以SPCE061A单片机为核心，串联光电编码盘位置测量、直流电机驱动、局部闭环反馈、无线数传反馈以及反射式红外传感器阵列寻迹，并给出点阵液晶与触摸屏人机交互设计，可作为课程设计、竞赛训练和控制系统入门的参考蓝本。包内共1个doc文件，约517KB，集中呈现原理图、代码与方案论证，便于对照硬件模块理解控制策略、误差修正和轨迹探测的实现逻辑。已有993人学习，适合需要从方案比较、硬件设计到程序实现完整梳理悬挂运动控制系统的读者。

1. 一根线吊着画笔，在坐标纸上画圆

第一次翻到这份资料时，最抓人的不是电路图，而是它对场景的描述：两副定滑轮架在 80cm×100cm 坐标纸上方，两根悬线吊着一支画笔，单片机要让它精确走到 (80,60)、画出直径 50cm 的圆、还能贴着一条手画的黑线走完全程，误差要求压到毫米级。这就是悬挂运动控制系统最直观的形态——看似简易的两轴绳索机构，背后却同时涉及位置解算、电机伺服、光电检测和无线通讯等技术。

这套完整版资料包含方案论证、硬件原理图、软件流程图和实测数据表，适合三类人：正在做运动控制课设的学生、想搞明白「绳索并联机构怎么定位」的嵌入式开发者，以及需要一套可复现的多模块协同参考设计的工程师。它用一颗 16 位单片机加两片专用驱动芯片，把成本压到了很低，却把闭环思想做得很完整——这一点比很多堆料方案更有参考价值。

2. 系统架构拆解：四模块分工与双机结构

整套系统的骨架并不复杂，但每一块的选型都经过了取舍。要读懂这套悬挂运动控制系统的代码，先得弄清楚信号是怎么在四个模块之间流动的。

2.1 总体框图：主控、驱动、检测、悬挂四块怎么连

系统被切成主控制模块、电机驱动模块、检测反馈环节、悬挂模块四部分。主控负责解算坐标、生成 PWM、刷新液晶；驱动把 PWM 放大成能带动减速电机的电流；检测反馈包含两条独立链路——一条是编码盘测线长，另一条是红外阵列测黑线；悬挂模块则是那片会跑的电路板，上面挂着画笔和传感器。

值得注意的是采用了双机结构：一片单片机留在原地做主控与人机交互，另一片跟着悬挂物跑，专门采集 8 路红外信号，再通过微功率无线数传模块把结果发回主控。这么拆的理由很实际——如果让主控去直接读悬挂物上的传感器，就必然要拖一根多芯排线过去，而排线的刚度会直接给悬挂物施加侧向拉力，坐标越远误差越大。把探测端做成独立节点，悬挂物上只剩电池和无线模块，机械负载干净了很多。

常见做法是把从机做成一个极简的定时采样 + 打包发送循环，主控则跑一个「收包 → 解算 → 输出」的状态机，两边靠一个固定的帧头字节对齐。这套结构的好处是从机代码几乎不用改，换传感器只动主控解析部分。

2.2 位置测量为什么放弃步进电机和位移传感器

原文把三种定位方案摆在一起比较，这个比较过程值得完整保留，因为它解释了后面所有算法的前提。

位移传感器方案受光电鼠标启发，直接取相对坐标偏移量。精度确实高，但它是增量式的，一旦掉帧就再也没有绝对基准，而且 USB 协议栈对一颗单片机来说负担太重。步进电机方案看似最「正统」，转动一步 0.9°，线位移能到毫米级，但题目要求悬挂物重量大于 100g，电机转矩必须做大，转矩一大静止锁死电流就上去了，电源功耗和发热都难控制；更麻烦的是高频运转时的失步，一旦失步，之前算的所有脉冲全部作废，且没有任何反馈能发现这件事。

最终选的直流电机 + 光电编码盘，本质是把「角度」换成「脉冲计数」。编码盘与电机轴同轴，码盘两侧放透射式红外对管，转过一条缝产生一个脉冲，脉冲数乘以带轮周长再除以减速比就是线位移。成本比步进方案低，驱动电路只要一片集成 H 桥，代价是需要额外的零点校准——而这个代价，恰好被后面的局部闭环环节补上了。

我一般会把这段换算写成一句常量表达式放在头文件里，方便改带轮尺寸时只改一处：

/* 线位移与编码器脉冲的换算常量，全部用 0.1mm 定点，避免浮点开销 */ #define PULLEY_DIA_01MM 120L /* 带轮平均直径 12.0mm */ #define GEAR_RATIO 30L /* 减速箱减速比 30:1 */ #define ENCODER_PPR 20L /* 码盘每转脉冲数，按实际码盘改 */ /* 一个脉冲对应的线位移，单位 0.1mm，用整数倒数近似 */ #define MM_PER_PULSE_X1000 \ (3141L * PULLEY_DIA_01MM / (GEAR_RATIO * ENCODER_PPR))

这段宏的意义在于把「机械参数」和「控制逻辑」隔开。PULLEY_DIA_01MM 改大，同样的脉冲数就代表更长的线；ENCODER_PPR 是码盘缝隙数，换码盘时只改这里。用 0.1mm 定点而不是浮点，是因为这颗单片机跑浮点乘除的开销会明显拖慢 PWM 更新周期，控制环一慢，画圆就会出棱角。

2.3 无线反馈替代有线：省掉的不只是那根线

方案论证里有一句话很关键：有线连接时，较多线缆会更多地导致悬挂物体运行误差。这不是理论推演，是实打实的力学问题——悬挂物在坐标纸远端时，排线的悬垂段自重会产生一个指向原点的分力，这个力的大小随位置变化，无法用固定的补偿量抵消。

改用微功率无线数传后，系统被物理切成探测部分和控制部分，视距可靠传输距离远超 100cm×80cm 的台面尺寸，余量足够。代价是引入了通讯延迟和丢包，所以软件上必须做两件事：给每帧数据加序号，主控侧发现序号跳变就丢弃该帧而不是硬用；以及设定一个超时阈值，超过若干毫秒没收到新数据就原地停机而不是继续按旧坐标外推。这两条如果漏掉，寻迹时会出现「明明该转弯却直冲出去」的现象，排查起来非常费时间。

2.4 控制策略：开环差在哪，闭环补了什么

开环方案靠「数脉冲」推断走了多远，问题是打滑、线径不均、码盘漏计都会累积，而且系统自己不知道偏了。局部闭环的思路很巧：悬线用 0.29mm 漆包线，隔固定距离刮掉一小段漆露出铜芯，悬挂物路径上装两个由图钉改的检测开关，导线经过裸线段时两个图钉被短接，主控读到一个电平跳变，就把当前线长值强制刷成标称值。

这相当于在一条长绳上打了若干个「绝对刻度」，每次经过就把累计误差清零。它不需要昂贵的绝对值编码器，也不需要对整根线做精密加工，成本几乎为零，却把误差从「随距离线性增长」压成了「在一个校正区间内浮动」。原文测试里点到点运动三次重复的停止位置偏差都在 0.5mm 以内，这个环节贡献很大。

实际接线时要注意两个图钉的间距必须略大于裸线段长度，否则会一直短接、校正线程反复触发；同时检测电路一侧上拉、一侧接地，中间串一个小电阻限流，避免裸线段上有毛刺时把 IO 口拉坏。

3. 硬件链路：从 PWM 到 L298 再到码盘整形

看懂架构只是第一步，真正上手搭的时候，翻车点几乎全在模拟侧和电源侧。

3.1 电机驱动：L298 两路输出与正反转控制

驱动没有自己搭分立 H 桥，直接用专用芯片的两路功率输出，电路工作过程在原文写得很清楚：PWM 信号接到使能端，方向端给低电平电机正转，给高电平反转，其他组合停转。这样一路信号管速度、一路管方向，软件上非常干净。

/* 单路直流电机控制：ch=0 左电机，ch=1 右电机 */ #define PWM_FULL 0x3FFF /* 假定 PWM 占空比寄存器满量程 */ void motor_run(unsigned char ch, signed short speed) { unsigned short duty; if (speed > 0) { /* 正转：方向脚拉低 */ if (ch == 0) { IOA_CLR = DIR_L_PIN; } else { IOA_CLR = DIR_R_PIN; } duty = (unsigned short)speed; } else if (speed < 0) { /* 反转：方向脚拉高 */ if (ch == 0) { IOA_SET = DIR_L_PIN; } else { IOA_SET = DIR_R_PIN; } duty = (unsigned short)(-speed); } else { /* 停转：占空比归零 */ duty = 0; } if (duty > PWM_FULL) { duty = PWM_FULL; } /* 限幅，防止溢出反转 */ pwm_set_duty(ch, duty); }

这里有两个必须写的保护：一是 duty 的限幅，负数的绝对值可能超出满量程，直接写寄存器会造成意料之外的输出；二是停转时先清占空比再谈方向，否则在方向切换瞬间容易出现短暂的短路制动电流。参数 speed 用的是带符号短整型，正负代表方向、绝对值代表占空比，这样上层算法算出来的「线长差」可以直接当速度用，符号天然表示该收线还是放线。

电机是带减速箱的，额定 12V、减速比 30:1、输出力矩大于 2400 g·cm。按带轮直径 12mm 折算，悬线牵引力远超 100g 的负载要求，所以系统有充足的加速度余量。但余量大不等于要全用——我一般把实际占空比上限压到 70% 左右，留出加速度缓冲，画圆时轨迹会明显更圆。

3.2 光电检测：反射式寻迹与透射式码盘的信号整形

系统里用了两种光电传感器，原理不同但后级处理一样。

反射式用于黑线检测：红外二极管发光，白底反射强、光敏三极管导通，A 点为低；黑线反射弱、三极管截止，A 点为高。透射式用于码盘：码盘夹在二极管和三极管之间，转过一条缝就通一次光，每转产生固定数量的脉冲。两种信号都送进带施密特触发功能的反相器整形，再进单片机。

施密特这一步千万别省。反射式传感器在黑白交界处输出会有一段缓慢过渡的中间电平，直接进 IO 口读出来的值随机跳；码盘在低速时更明显，脉冲边缘会有一串抖动，计数值会多算。整形之后边沿变陡，配合同步计数，漏计基本消失。

8 个红外对管围成一个环套在画笔周围，各传感器之间留出特定间距，保证黑线落在任意方向时至少有一个探头能压到线上。这个间距是整个寻迹能力的基础，间距太大拐角会漏，太小则相邻探头互相干扰、遮蔽范围不够。

3.3 局部闭环校正：图钉开关与剥漆导线的配合

前面提到的校正装置，硬件上极简：悬线中段按固定间距剥出一小段裸铜，两个图钉分别接「拉高电平」和「接地」两个检测点。导线正常时两个图钉被漆层隔开，检测点读到高电平；走到裸线段时两点被短接，读到低电平。

软件里对应一个校正服务：一旦检测到低电平跳变，就把当前的左右线长计数值重置为标称值（按剥漆点位置算出来的理论线长）。这里有个顺序问题——必须先判断是「左线触发」还是「右线触发」，再更新对应那一路的计数，否则会把左线的校正量写到右线上，越修越偏。

剥漆段的长度建议取 3～5mm，太短容易因为线的摆动漏触发，太长则每次校正持续的时间久，期间坐标显示会有一个跳变，影响操作体验。另外剥漆处要保证铜芯完整，不能有断股，否则悬线在该处的抗拉强度会下降，跑到远端时容易崩断。

3.4 人机交互：点阵液晶与触摸屏的参数标定

交互部分由点阵液晶和触摸控制屏组成，主界面用菜单形式给出六项功能入口：手动调零、设定坐标运动、执行设定坐标、画圆、寻迹、人工轨迹。触摸屏负责选菜单和设坐标，液晶负责实时显示当前画笔坐标。

触摸屏上电必须标定，这一点在原文里没展开，但它是实际搭建时最容易卡住的地方。常见做法是开机画两个十字准星，让用户依次点中，记录原始 AD 值，反算出线性映射的斜率和截距存到参数区。如果不标定，点「80,60」可能落到「90,55」，后面所有测试数据都对不上。液晶侧则要注意刷新频率——坐标显示每 100ms 左右刷一次就够，刷太快会抢占 PWM 中断的时间片。

4. 算法与软件流程：三段轨迹怎么算出来

硬件决定了系统能感知什么，算法决定了它能画成什么样。这部分是整份资料里最值得逐行看的内容。

4.1 点到点运动：勾股定理算出两条线的长度差

悬挂物的位置由两条悬线长度唯一确定，所以「走到某点」等价于「把两条线收到指定的长度」。设左滑轮中心为原点、两个定滑轮中心距为 W，目标是坐标 (x,y)，那么两条线长就是两个直角三角形斜边：

• 左线长 L_left = √(x² + y²)
• 右线长 L_right = √((W − x)² + y²)

知道当前位置的线长和目标位置的线长，两者相减就是每个电机要收放的线量，再乘换算常量变成脉冲数。这就是点到点算法的全部——没有 PID，没有插补，纯几何解算，因为闭环环节已经把机械误差吃掉了。

typedef struct { long x; long y; } point_t; /* 单位 0.1mm */ /* 整数开方：二分法，比调用浮点 sqrt 快且无需链接数学库 */ static long isqrt_long(unsigned long v) { unsigned long lo = 0, hi = 46340, mid; /* sqrt(LONG_MAX) 上界 */ while (lo < hi) { mid = (lo + hi + 1) >> 1; if (mid * mid <= v) { lo = mid; } else { hi = mid - 1; } } return (long)lo; } /* 由坐标反解两悬线长度，结果单位 0.1mm */ void coord_to_line(point_t p, long *l_len, long *r_len) { unsigned long a, b; a = (unsigned long)(p.x * p.x + p.y * p.y); b = (unsigned long)((PULLEY_SPAN - p.x) * (PULLEY_SPAN - p.x) + p.y * p.y); *l_len = isqrt_long(a); *r_len = isqrt_long(b); }

参数 PULLEY_SPAN 要跟机械装配严格一致，量错 5mm 就会在所有点上引入同向偏差。用二分法开方而不是 sqrt，是因为片内没有浮点协处理器时软件浮点 sqrt 一次要几百个周期，10ms 的控制周期会被明显拖慢。二分法迭代约 16 次，纯整数运算，稳。

一个容易忽略的细节：实际带轮半径约 10mm，绕线时线在轮上会叠层，半径随缠绕层数变化。原文明确说了「忽略轮半径带来的绕线误差」，所以算法里可以直接用理想值。如果要把精度再往上推，就得引入缠绕补偿表，这个后面二次开发再谈。

4.2 圆周运动：余弦定理加角度步进

画圆不能靠「一边收一边放」硬凑，那样出来的轨迹会明显不圆。原文的做法是把圆心 O 和半径 R 固定，让悬挂点 C 沿圆周按角度步进，每步用余弦定理重新算两条线长：

• AC² = AO² + CO² − 2·AO·CO·cosα
• BC² = BO² + CO² − 2·BO·CO·cosβ
• 且 α + β = 2π − ∠AOB（∠AOB 由两个滑轮与圆心构成的三角形确定）

把 α 按固定步进（比如 2°）递增，每步解出 AC 和 BC，与上一步的差值就是这一小段要收放的线量。

/* 圆周运动：圆心 (ox,oy)，半径 r，一圈分 STEPS 步 */ #define STEPS 180 /* 2 度一步 */ void circle_move(point_t o, long r) { point_t cur; long n, ang, lc, rc, lp, rp; long left_delta, right_delta; /* 先解算出起点位置，作为第一拍的基准 */ cur.x = o.x + r; cur.y = o.y; coord_to_line(cur, &lp, &rp); for (n = 1; n <= STEPS; n++) { ang = (long)n * 3600 / STEPS; /* 单位 0.1 度 */ sin_cos_01deg(ang, &cur.x, &cur.y);/* 定点查表求 sin/cos */ cur.x = o.x + r * cur.x / 1000; cur.y = o.y + r * cur.y / 1000; coord_to_line(cur, &lc, &rc); left_delta = lc - lp; right_delta = rc - rp; /* 把线量差转成速度，输出到两路电机，正负自动对应收放线 */ motor_run(0, (signed short)(left_delta * SPEED_GAIN)); motor_run(1, (signed short)(right_delta * SPEED_GAIN)); lp = lc; rp = rc; delay_ms(20); /* 等电机走完这一小段 */ } }

关键参数是 STEPS 和 SPEED_GAIN。STEPS 越大轨迹越圆但总时间越长，原文实测直径 50cm 的圆用了 57～62 秒，对应每步几十毫秒。SPEED_GAIN 是线量差到 PWM 占空比的转换系数，调大了会在起点和终点附近过冲，调小了走不到位累积成椭圆。我一般从「一小段线量差 × 2」开始试，观察轨迹是否闭合再微调。

sin_cos_01deg 用查表而非实时计算，180 个点的表占几百字节，换来的是一圈算下来几乎不占时间，这是这类小资源单片机上很典型的取舍。

4.3 任意轨迹寻迹：主探测器加屏蔽三对的轮换策略

寻迹是全文最巧的一段。8 个红外对管围成一圈套在画笔外，黑线方向任意，不能固定用某一个探头当基准，否则遇到急弯就丢线。

做法是这样的：每次探测都有且只有一个「主探测器」A，把 A 后面（沿上一状态的偏移方向）的三个探测器屏蔽掉，只保留包含 A 在内的 5 个参与判断。主探测器由上一状态决定——记录上一拍哪几个探头压到了黑线，算出它们相对当前主探测器的角度偏移量，取平均，就得到下一拍的主探测器编号。

这么设计的效果是：探头窗口跟着黑线的走向转。线往右拐，主探测器就往右移一位，屏蔽区也顺带转过去，不会出现「左边探头一直压着已经走过的线」这种误判。

/* 8 路红外，bit0..bit7 对应环上 0..7 号探头，1 表示压到黑线 */ static unsigned char pick_main(unsigned char raw, unsigned char last_main) { unsigned char i, sum = 0, cnt = 0, off; for (i = 0; i < 8; i++) { if (raw & (1 << i)) { /* 只统计有效探头 */ off = (i + 8 - last_main) & 0x07; /* 相对上一主探测器的偏移 */ if (off > 4) { off -= 8; } /* 折算到 -3..+4 便于取均值 */ sum += off; cnt++; } } if (cnt == 0) { return last_main; } /* 全白，原地保持，交给超时处理 */ off = sum / cnt; /* 平均偏移，注意有符号除法 */ return (unsigned char)((last_main + off + 8) & 0x07); } /* 屏蔽主探测器之后的三个，只留 5 个参与方向判定 */ static unsigned char mask_followers(unsigned char raw, unsigned char main_probe) { unsigned char mask = 0xFF, k; for (k = 1; k <= 3; k++) { mask &= ~(1 << ((main_probe + k) & 0x07)); } return raw & mask; }

pick_main 里那个off > 4的折算很重要：环是首尾相接的，7 号探头相对 0 号的偏移应该是 −1 而不是 +7，不折算的话平均出来的方向会完全错掉。cnt 为 0 的分支对应「脱线」，这时不能随便选方向，必须返回上一拍的主探测器并让上层计时，超时就停机报警——这条如果写成「默认取 0 号」，脱线后画笔会朝固定方向一路狂奔。

mask_followers 屏蔽三个探头是个经验值：太少挡不住身后的干扰，太多会缩小可视角度，急弯时等你转过来线已经跑出窗口了。

4.4 主程序与调零子程序：状态机怎么组织

主程序是个标准的「开机画面 → 键值轮询 → 分支执行」结构，六个按键分别对应手动调零、设定坐标、执行坐标、画圆、寻迹、人工轨迹。运动子程序内部是：读入设定坐标 → 读入当前悬线长度 → 计算左右电机策略 → 显示实时坐标 → 控制电机 → 判断是否到位 → 返回。

调零子程序单独拎出来，因为它决定了所有绝对坐标的可信度。手动调零通过四个方向键让左右电机正反转，把悬挂物拉到机械原点，此时把两个线长计数器清零。原文的流程图里这一步是键盘扫描加电机点动的循环，实现上要注意按键松开就立即停电机，不能靠延时后自动停。

我把这部分抽象成一个状态机，比一堆 if-else 好维护：

typedef enum { ST_IDLE = 0, ST_ZEROING, /* 人工调零中 */ ST_GOTO, /* 点到点运动中 */ ST_CIRCLE, /* 画圆中 */ ST_TRACE, /* 寻迹中 */ ST_FAULT /* 脱线/超时/无线丢失 */ } sys_state_t; static sys_state_t g_state = ST_IDLE; void main_loop(void) { unsigned int key; while (1) { key = key_scan(); /* 触摸屏/按键扫描 */ switch (g_state) { case ST_IDLE: if (key == KEY_ZERO) { g_state = ST_ZEROING; } if (key == KEY_GOTO) { g_state = ST_GOTO; } if (key == KEY_CIRCLE) { g_state = ST_CIRCLE; } if (key == KEY_TRACE) { g_state = ST_TRACE; } break; case ST_GOTO: if (goto_step() != 0) { g_state = ST_IDLE; } /* 到位返回 0 */ break; case ST_TRACE: if (trace_step() < 0) { g_state = ST_FAULT; }/* 脱线返回负 */ break; case ST_FAULT: motor_stop_all(); lcd_show_msg("LINE LOST"); /* 停在原地等人工干预 */ if (key == KEY_RESET) { g_state = ST_IDLE; } break; default: break; } refresh_lcd_coord(); /* 约 100ms 刷一次坐标 */ } }

状态机最大的好处是把「异常停机」变成一个显式状态。物理系统出问题时最怕程序还在按旧数据闷头输出，ST_FAULT 这一支保证任何异常都能落到一个所有电机断电的确定点上。

5. 常见问题排查：从原理图到联调的五条血泪记录

原理图和代码都在手，真正难的往往是第一次上电到第一次画出圆之间的那段。以下五条是按「现象 → 原因 → 解决」整理的实测记录。

5.1 上电联调的正确顺序

先不接电机，只上主控和液晶，确认开机画面和触摸响应正常；再接电机驱动，用固定占空比让两个电机各自正反转，确认方向定义和接线一致；然后接编码盘，手动转动带轮看计数值是加还是减；最后接无线模块，确认从机能稳定发包、主控能正确解析坐标。

这个顺序不能反。曾经为了省事一次性全接上，结果上电后电机乱转，花了半天才定位到是方向引脚和 PWM 引脚在排线上接反了——如果分步验证，第二步就能发现。

5.2 五条踩坑记录

现象一：每次上电后第一次点到点运动都偏 3～5mm，第二次开始就正常。原因是上电时线长计数器初值为零，但悬挂物实际不在原点，所有绝对坐标都带着这个偏移。解决是把人工调零做成强制流程，开机后不调零不允许进入运动模式；或者在 EEPROM 里存上次断电时的线长值，上电先恢复再微调。

现象二：电机一启动，液晶花屏或单片机复位。电机启动瞬间电流能到数安培，共地阻抗上产生的压降把单片机电源拉塌。解决是电机电源和逻辑电源分开走线、单点共地，电机两端并一个 0.1μF 加一个电解电容，驱动芯片电源脚就近去耦。别指望软件能救这个，这是电源问题。

现象三：寻迹在直线段很稳，一到急弯就冲出去。主探测器的屏蔽窗口把拐角方向的探头也挡住了，等主探测器转过来时线已经出了可视范围。解决是减小角度步进（走得更慢，每步转角更小），或者把屏蔽数量从三个减到两个，牺牲一点抗干扰换回拐角视野。

现象四：画圆时起点和终点不重合，开口 5mm 左右。两个原因：一是 STEPS 太小，每步转角 2° 以上时弦长替代弧长带来的误差累积；二是一圈下来编码盘的累计误差没有被清零。解决是把 STEPS 提到 180 以上，并在画圆前先走一次找校正点的动作，让局部闭环把计数刷准再开始。

现象五：液晶上的坐标偶尔跳变一大截，但电机没动。无线帧被干扰后解析错位，把数据字节当成了帧头。解决是帧格式加固定帧头 + 长度 + 校验和，校验不过直接丢；同时给每帧加序号，主控发现序号不连续就丢弃该帧并维持上一有效坐标，不做外推。

6. 二次开发：把毫米级精度再往前推一步

这套系统的天花板主要卡在三个地方：绕线半径随层数变化、编码盘分辨率有限、控制律是纯几何解算没有加减速规划。想继续做深，从这三处下手性价比最高。

如果只想做最小改动拿到最大收益，我建议先做缠绕补偿，因为它纯粹是软件层的十几行代码。实现思路是维护一个「已收线长度」变量，用总长度除以单层缠绕周长得到层数，再套进有效半径公式：

/* 缠绕补偿：线径 0.29mm，每层半径增加一个线径 */ #define WIRE_D_01MM 3L /* 约 0.3mm，单位 0.1mm */ static long eff_radius(long wound_len) { long layers = wound_len / (2 * 3141L * PULLEY_DIA_01MM / 10000L); return PULLEY_DIA_01MM / 2 + layers * WIRE_D_01MM; }

这行代码不能直接插到原来的 coord_to_line 里，因为原来的解算是「由坐标求线长」，而补偿需要「由当前线长求有效半径」，两者互为因果。可行的做法是先用理想半径解一遍得到近似线长，再用近似线长算补偿后的半径，迭代一次就够了——误差是二阶小量，再迭代下去收益递减。

验证改造效果的方法要固定下来，否则改完不知道是变好还是变坏。我的习惯是在坐标纸上取五个固定点（四角加中心），每个点往返走十次，记录每次的停止坐标，算均值和标准差。只看单次误差会被偶然因素误导，看标准差才能判断一致性是否真的改善了。另外每次改完只动一个参数，动两个以上就说不清是谁的功劳。

最后说个教训。我早期调这类系统，总是先盯着算法改，恨不得把 PID 加进去，结果绕了一大圈才发现是图钉检测开关的接触不良导致校正时灵时不灵。从那以后我每次动控制代码之前，都强制先把机械和电气部分用示波器过一遍——编码器波形、红外对管在黑白交界处的边沿、图钉开关的通断，全部确认干净再谈算法。硬件没稳住的时候，再漂亮的控制律都是在给噪声做整形。希望帮到你。

本文还有配套的精品资源，点击获取