1. 先分清两种“跑偏”：走不直和原地转圈是两码事
我接过不止一辆“总跑偏”的小车。问车主第一句话通常是：“是直线走着走着画弧线，还是一加油门就原地甩尾？”这两个看似都是跑偏，实际排查方向完全不同，搞混了就是在浪费时间。
第一种叫“方向性漂移”：小车匀速直线行驶时，轨迹逐渐偏向一侧。问题基本出在左右轮速度不一致、轮径不等、或传感器零偏上，属于稳态误差。第二种叫“瞬态偏转”：起步、刹车、急加速瞬间车头猛地偏一下，然后又回正。这种多半是重心偏移、加速度过大导致轮子打滑、或者左右轮响应延迟不匹配造成的，属于动态过程误差。
判断方法很简单：跑到一半用手轻推一下车尾，看它偏转后能不能自己回中；如果不能回中，说明开环或闭环都存在问题；如果能回中但直行时仍然持续偏，那就是稳态误差源没消除。
另外要留意一点——跑偏的方向会不会变。固定往右偏，大概率是机械或电机问题；今天左偏明天右偏，那几乎可以肯定是传感器零漂、陀螺仪温漂、或者电池电压波动导致电机输出不一致。先把这个定性搞清楚，下面的调试才有意义。我自己的习惯是把每次测试的“偏转方向、偏转速率、是否恒定、电压值”四项记录下来，对比三条以上数据，再去碰任何螺丝和代码。
2. 机械环节的三个隐性元凶：轮径、轴距与重心
很多人调跑偏，上来就改PID参数，我反而不太建议。只要机械结构有硬伤，PID调得再好也只能把“明显偏”变成“稍微偏”，永远不可能走直线。所以排查顺序我坚持先从机械开始。
2.1 轮径差异：0.5毫米就能让小车画出大圆弧
两个轮子的直径不一致，是跑偏最经典、最常见的原因。四驱小车用两个相同型号的轮子，你以为直径肯定一样，实际上注塑轮带胎皮的，左右相差1毫米都很正常。别小看这0.5毫米，轮径比差1%，走10米就能偏出大概2米弧线，非常明显。
测量方法：别直接量外径，因为轮胎有弹性、有花纹，游标卡尺压紧和放松结果都不一样。正确做法是在轮子上做个记号，把车悬空，用手盘动电机让轮子转10圈，用卷尺量记号移动的总弧长，除以10算出有效周长，再除以π得到等效直径。左右两个轮子都这样测，差超过1%就必须处理。
处理方式分三档：
- 固定机器人底盘：直接把小轮子换成稍大的，或者用热缩管套在轮毂上增大外径；
- 做原型验证：可以在小轮子外圈缠电工胶布，一圈一圈试，直到左右等效周长一致；
- 有条件的：上3D打印一个直径差几毫米的补偿轮套。
注意，调好后必须重新标定编码器的“每圈脉冲数”，因为等效周长变了，轮速和位移的换算系数也要一起改。
2.2 轴距与后轮“内八字/外八字”
左右轮安装位置不对称，同样会导致跑偏。常见的情况是：车身某个轮子的轴承座松动，或者底盘加工时孔位偏差，导致轮子轴线不平行。用手把车在地面推一段，如果车自己往一侧拐，而且转弯半径特别小，优先怀疑后轮轴线和车身纵轴不垂直。
检查办法：
- 把车放平，拿两个直角尺抵住底盘侧边，看左右轮轴心和车身侧壁的距离是否一致；
- 从车尾向前看，轮子有没有明显的内倾或外倾；
- 把车悬空，手动转动每个轮子，感受有没有周期性阻力，阻力不均匀往往意味着轮毂变形或者轴承损坏。
之前我遇到过一辆小车，左前轮轴承滚珠碎了半个，车走起来跟喝醉酒一样，左右飘忽不定。这种问题换任何软件参数都救不回来，只能换轴承。所以机械检查这一步完全不能省。
2.3 重心偏移：起步刹车时跑偏的第一嫌疑人
很多小车用锂电池，电池直接绑在底盘一侧，加上摄像头和舵机，重心严重偏向一边。静态的时候看不出问题，一旦启动、刹车，或者经过不平整地面，车身会绕重心旋转，跑偏就出现了。加速越猛，现象越明显。
验证重心是否偏：把车放在水平桌面，用手轻轻往左推一下、往右推一下，观察车是平稳回位还是往某一侧倒。再开机原地起步，看车头是否猛地朝某个方向甩一下。
解决方法优先级是这样的：先把所有重物（电池、主控板、摄像头支架）尽量往底盘几何中心集中；如果还偏，加配重块找平衡；最后才考虑调整左右PWM偏置去抵消。
我最常用的办法是：找五个同样大小的硬币，依次放在偏轻的那一侧，每放一枚就原地起步测试一次，直到起步不再甩头，然后称一下硬币总重量，找一个等重的配重块固定上去，干净利落。
3. 电机与驱动环节：开环跑偏的根源都在这里
机械没问题，接下来就是电机和驱动电路了。开环控制下，只要左右电机实际转速有差异，小车必偏，不需要任何其他解释。
3.1 左右电机转速一致性测量
标称相同的两个电机，空载转速差个3%到5%都很正常，这是生产工艺决定的，不是“坏了”。问题在于你的系统能不能容忍这个差异。
测量方法：写一个最简单的测试程序，固定输出50%占空比，分别读取左右编码器1秒内的脉冲数，多测几次取平均值。如果左右差异超过2%，就说明开环下速度本就不一致。
这时候必须先区分是电机本身差异还是编码器读数问题。把左右电机对调一下（或者把左右编码器接口互换），再测一遍。如果差异方向也跟着对调，那是电机差异；如果差异方向不动，那就是编码器安装或接线问题。
处理思路：
- 电机差异：用软件补偿，给慢的那一个电机增加一个固定的PWM偏置量，让两侧实测转速相等；
- 编码器问题：检查编码器码盘是否和电机轴同心、光耦是否沾灰、接线是否接触不良；
- 如果电机带减速箱，还要注意减速箱里润滑脂的状态，干涸后阻力差异也会让转速不一致。
3.2 供电与PWM死区：两个容易被忽略的坑
电池电压对跑偏的影响往往被忽视。锂电池放电过程中电压会下降，同样的PWM占空比，在不同电压下产生的平均电压不同，电机速度也就不一样。如果左右电机特性曲线有差异，电压一降，两侧转速差异还会被进一步放大。
更隐蔽的问题是PWM频率和死区。电机驱动板如果PWM频率设置太低，电机会有啸叫，转速还会抖动；设置太高，驱动芯片的响应跟不上，输出功率下降。一般直流电机建议8kHz到20kHz之间，具体看驱动芯片能承受的上限。
另外一个让我栽过跟头的坑：PWM占空比很小的时候，电机根本转不动。举个例子，占空比低于5%时电机静摩擦大于电磁转矩，轮子不转；一旦占空比跳到6%，电机突然启动，左边先启动、右边后启动，车头就猛地偏一下。解决办法是设置一个PWM阈值，程序里低于阈值的占空比直接输出为0，高于启动阈值后再开始线性调节，这样就不会出现一侧先动一侧后动的尴尬。
3.3 编码器信号质量与中断丢失
如果你的控制程序在读取编码器时丢脉冲，闭环控制就会崩溃，表现形式也是跑偏——但更诡异，是走走停停的间歇性偏转。
排查方法：
- 示波器看编码器A/B相波形是否带毛刺；
- 用串口打印读取到的原始计数，手动缓慢转动轮子，看数值是否连续而均匀地递增；
- 检查接线是否用了双绞线，编码器信号线和电机电源线有没有绑在一起走线。
如果编码器信号线太靠近电机大电流线，干扰会非常严重。我试过把编码器线和大电流线扎在一起，空载测试正常，一带负载就跑偏，查了半天才发现是干扰导致中断丢失。后来把编码器线单独走，包屏蔽铝箔，问题立刻消失。
4. PID闭环调不好，直线和弯道都会露馅
机械、电机、编码器都确认没问题，才轮到PID。很多教程上来就讲PID公式，但我觉得更重要的是先明确：你的系统里PID到底在控制什么、传感器测的是什么、执行器做的又是什么，这三点不拧到一起去，参数怎么调都是白费。
4.1 单闭环和串级闭环的选择
普通两轮差速小车，最常见的闭环结构是“轮速PID”：左右轮各自闭环，让每个轮子都精确达到目标转速。这样左右转速一致，直线就能走稳。这是单闭环。
但是单闭环有个问题：它只保证“车轮转速一致”，不保证“车身方向不变”。如果两个轮子转速都精确一致，但车身因为外力偏了一下，过后会继续偏着走，因为轮速PID没有航向反馈，不知道车身已经偏了。
所以更稳的方案是串级PID：外环用陀螺仪偏航角（yaw）做反馈，输出一个转向修正量；内环把这个修正量叠加到左右轮速目标上。这样车身一旦偏航，外环会立刻发现并修正回来。
区别用一句话总结：单闭环保证“轮子一样快”，串级闭环保证“车头朝正”。直线竞速、巡线、搬运这种需要长期走直线的场景，串级方案远比单闭环可靠。
4.2 先调内环再调外环，顺序千万别反
串级PID的调试顺序有一个铁律：先内环，后外环。
内环节奏步骤：
- 只让车悬空，拆卸负载，直接给轮速目标，观察轮速响应；
- 先调P：从小到大加，观察轮速是否快速接近目标且不振荡；
- 再加I：消除稳态误差，但积分不能太强，否则低速时会出现“锯齿状”一顿一顿的现象；
- D项在轮速环里一般用得少，因为编码器测速本身就带噪声，微分放大噪声会加剧抖动。
内环调稳了，再调外环（航向环）：
- 把车放地上，设一个目标航向（比如0度），看车头能否回正；
- 外环P加太大，车头会来回摆动，就像新手开车猛打方向盘；
- 外环I加太大，车会出现“低频振荡”——走几步往左偏一点拉回来，再往右偏一点拉回来，姿态呈S形前进；
- 外环D可以有效抑制过冲，但对陀螺仪噪声敏感，需要先对yaw数据做低通滤波再送进微分项。
4.3 一个重要经验：死区必须加在航向误差上
小车在实际地面运行时，航向角总是在一个很小区间内波动。如果外环对每个微小波动都全力修正，会出现明显的“抖动式跑偏”——看起来车都在纠正方向，实际上车身在左右小幅度甩动，轨迹反而画不出直线。
解决办法：设置一个航向死区（比如正负0.5度，视传感器噪声水平而定），误差绝对值小于死区时不输出修正量，大于死区才介入修正。这样车子不是一直在“修正”，而是只在真正偏了以后才动方向，反而走得更稳。
我在实操中常用的初始参数参考表：
| 环路 | P | I | D | 效果特征 |
|---|---|---|---|---|
| 内环轮速 | 10-20 | 0.5-1.5 | 0 | 响应快，无超调 |
| 外环航向 | 2-5 | 0.1-0.3 | 0.5-1.5 | 回正平滑不死板 |
| 航向死区 | 0.3-0.8度 | - | - | 不抖，不画蛇 |
这只是起点，实际参数跟底盘结构、电机响应速度、传感器采样频率都强相关，必须以实测为准。
5. 传感器与数据融合：小车的“直觉”也会骗人
如果上面的环节都排查了、调了，车子还是偶尔抽风式跑偏，那就得怀疑传感器给控制器的“感受”本身是错的。这一层的问题很有迷惑性，因为机械和代码都改过很多遍了，很难想到是“眼睛”出了问题。
5.1 编码器标定：出厂值未必可靠
编码器的“每圈脉冲数”参数，不同批次的产品可能有细微差异。更关键的是，实际使用的等效轮径跟理论值往往差几个百分点——轮胎气压、胎皮磨损、负载大小都会改变有效半径。如果程序里用理论值换算，左右轮虽然编码器读数一致，实际行驶距离却不一致，照样跑偏。
标定方法：在地面贴一条10米长的美纹纸，让小车沿直线行驶，用遥控或程序控制走到头，记录左右编码器累计脉冲数。多跑几次取平均值，然后用“实际行驶距离 ÷ 平均累计脉冲数”算出每个脉冲对应的实际毫米数，把这个值写进程序。
这个标定一定要在车满载、地面和比赛时类似的环境下做。原因很简单：负载不同，轮胎变形量不同，有效半径不同，换算系数也不同。空载标定的数据，满载后就不准了。
5.2 陀螺仪安装偏差与零漂
陀螺仪焊接歪了1度，启动时零偏没有校准掉，都会造成一个固定偏置，让航向环误以为车身一直在偏，于是不停地修正，结果车子就朝反方向画弧。
排查办法：
- 把车静止放在桌面，连续读取1分钟yaw值，如果缓慢漂移，说明零偏未校准或温漂严重；
- 把车放在水平台上，正对车头方向立一个直角尺，开机读取初始yaw值，如果不是0度，说明安装角度有偏差，需要在程序里减去这个偏移量；
- 观察yaw数据的噪声幅值，如果噪声超过0.5度，航向环根本没法用，得先上滤波。
陀螺仪零漂我认为是传感器问题里最闹心的，因为温漂规律不固定，今天校准了明天又飘。我的做法是每次上电后在静止状态下采集200个样本取平均作为零偏，写入变量做动态补偿；同时设定一个阈值，如果连续一段时间检测到静止，自动重新校准。
5.3 数据融合：互补滤波和卡尔曼的实际取舍
航向角通常由陀螺仪积分获得，但积分会有累积漂移；磁力计能提供绝对航向但容易受电机磁场干扰；加速度计能提供倾角但不能测偏航。所以常见的做法是把陀螺仪和磁力计（或视觉里程计）融合。
对小车主控（STM32、ESP32等）来说，卡尔曼滤波虽然效果好，但调参麻烦，运算量也大。而互补滤波实现简单，效果在小车这个场景下完全够用。互补滤波的本质就是一句话：短时间信陀螺仪（积分精确但会漂），长时间信磁力计（有绝对参考但噪声大）。
实操中，加速度计和磁力计都要先做好校准，尤其是磁力计的硬磁干扰——电机和电池旁边的大电流走线会产生磁场偏移，直接让磁力计以为是航向变化。解决办法：装车前先让小车绕自身轴线转几圈，采集磁力计最大值和最小值，用椭圆拟合修正；装车后再重新校准一次，因为电机、电池等铁磁材料会改变磁场的分布。
6. 一套可复现的排查流程：从现象到数据的完整链路
前面讲了很多环节，但实际调试时最怕的是东一榔头西一棒子。这节我给出自己一直在用的完整排查链路，按顺序走，基本能把跑偏问题定位到具体环节。核心思路只有一个：一切判断依靠数据，不要凭感觉。
6.1 搭建数据记录环境
你需要能实时看到小车的内部状态，而不是只看它的运动轨迹。我用的工具组合：
- 串口调试助手（SSCOM或正点原子助手都行），用来实时打印内部变量；
- 一个小脚本（Python / Processing / 或直接Excel）把串口日志解析成曲线；
- 一个能记录“目标转速、实际左右轮转速、yaw角、PWM占空比、电池电压”的打印函数，频率50Hz就够。
串口打印建议带上时间戳和循环计数。之前我吃过亏：数据没时间戳，车跑完回来无法对应哪段数据是哪个阶段跑的，等于白记录。
打印格式大概长这样（留个参考）：
def debug_print(t, vbat, target_l, act_l, target_r, act_r, yaw, pwm_l, pwm_r): print(f"{t:.2f},{vbat:.2f},{target_l:.0f},{act_l:.0f},{target_r:.0f},{act_r:.0f},{yaw:.2f},{pwm_l:.0f},{pwm_r:.0f}")6.2 跑一次直线，看四条关键曲线
让小车以固定占空比跑一段5米直线，同时记录数据。重点看以下几项：
- 电池电压曲线：如果跑的过程中电压掉得厉害，说明供电不足或线路压降大，先解决供电再谈跑偏；
- 左右实际转速曲线：如果左右转速差持续超过2%，而且PWM输出已经做了偏置补偿仍然拉不齐，问题在机械或电机；
- yaw曲线：如果yaw线性增长（比如匀速每秒增加2度），说明车在以恒定角速度偏航。此时去看左右轮速差，如果轮速差和yaw增长率能对得上，证明是速度差异导致的跑偏；如果轮速差是0但还是偏，那就是传感器零偏或安装偏差；
- PWM输出曲线：如果PWM左右差异很大，但实际转速仍然不一致，说明电机负载特性差异太大，单纯加偏置不能根本解决，要考虑换电机。
给你一个快速定位表格：
| 现象 | 轮速差 | yaw特征 | 主要嫌疑 |
|---|---|---|---|
| 固定往右偏 | 左快右慢 | 匀速增长 | 机械/电机差异 |
| 固定往右偏 | 左右一致 | yaw初始值不为0 | 陀螺仪零偏或安装 |
| 时左时右 | 抖动 | 低频振荡 | PID参数 |
| 起步猛偏 | 突发不同 | 短时尖峰 | 重心偏移/启动阈值 |
| 间歇性偏 | 偶发跳变 | 无规律 | 编码器干扰/接线 |
6.3 定好优先级，别越级调参
我的排查顺序始终是：机械（轮径/轴距/重心） → 电气（供电/驱动/PWM死区） → 轮速闭环 → 航向闭环 → 传感器标定。每完成一项，都跑一次直线看数据。只有当前环节没有问题了，才允许进入下一环节。
有人会问：为什么不直接上航向闭环，让它自己纠正跑偏？因为航向闭环只能“纠正”跑偏，不能“消除”跑偏的根源。如果左右轮速差不解决，航向环为了保直线，会不断输出一个很大的偏置PWM，这个偏置会让左右轮速明显不一致，弯道性能、能耗、电机寿命都会受影响。一个健康的闭环系统，航向修正量应该是小幅波动的，不是长期顶着一个大偏置。
最后分享一个我个人的经验：调车调到想放弃的时候，先停下来检查轮胎胎压。我遇到过不止一次，折腾一整天找跑偏原因，结果发现是某个轮子慢漏气。做机器人调试，数据是依据，但最简单的物理检查往往能省下最多时间。排查链路的完整价值，就在于把可控变量一个一个锁死，最终剩下的那个才是真凶。
