1. 从一次“跑偏”事故说起为什么灰度循迹需要优化去年秋天我帮一个做园区安防的朋友调试一台巡检小车。硬件底子不差——STM32F407VET6最小系统板五路灰度传感器TB6612驱动双直流减速电机带霍尔编码器。按理说这种配置跑个黑线循迹应该是手到擒来结果第一次上跑道就给我上了一课小车在直线段跑得挺欢一进弯道就开始“画龙”要么冲出去压线要么在弯心原地打转。更离谱的是同一段赛道跑三圈三圈的轨迹都不一样。这个现象其实非常典型。很多刚接触智能巡检小车的朋友会把注意力全放在“传感器能不能识别黑线”上觉得只要灰度模块输出正常循迹就是顺理成章的事。但真正跑起来才发现灰度循迹的核心难点从来不是“看到线”而是“怎么优雅地跟住线”。传感器给的是离散的位置偏差电机响应有延迟车体有惯性电池电压还会随着放电往下掉——这些因素叠加在一起如果控制策略太粗糙小车就会表现得像个醉汉。我后来花了大概两周时间把这台小车的循迹系统从“能跑”优化到“跑得稳、跑得快、跑得一致”中间试过纯阈值法、位置式PID、增量式PID最后落到灰度加权偏差 增量式PID 动态速度规划的组合方案上。这套方案在STM32F407VET6上跑下来资源占用很低弯道最大速度能比原来提升约40%而且重复精度明显改善。这篇文章就把整个优化过程拆开讲清楚。适合正在做智能巡检小车、循迹小车、竞速小车的朋友参考不管你是刚入门还在调阈值还是已经上了PID但效果不理想应该都能从里面找到能直接用的东西。核心关键词就几个STM32F407VET6、灰度循迹、PID、模糊控制我会围绕它们把原理、参数、代码、踩坑经验都摊开说。2. 系统整体设计与方案选型思路2.1 为什么选STM32F407VET6而不是F103先说主控选型。市面上循迹小车用得最多的其实是STM32F103C8T6便宜、资料多、够用。那我为什么在这台巡检小车上用了F407VET6原因有三个都是实际需求倒逼的。第一是算力余量。F103是72MHz Cortex-M3跑单纯的阈值判断绰绰有余但一旦上PID、还要做速度闭环、再加上OLED刷新和串口调试输出主循环就开始吃紧。F407VET6是168MHz Cortex-M4带FPU做浮点PID运算几乎不占时间我实测跑完整套控制循环灰度采集偏差计算PID双电机速度闭环状态机只用了不到200微秒留给其他任务的空间非常充裕。第二是外设资源。F407VET6有3个12位ADC、多个高级定时器TIM1/TIM8、丰富的USART和SPI。灰度传感器如果用模拟输出可以直接接ADC做加权计算比纯数字阈值精细得多电机编码器用定时器编码器模式采集调试串口、OLED、上位机通信各占一个互不打架。第三是未来扩展。巡检小车后面可能要加超声波避障、IMU、无线模块F103的引脚和算力很快就会见底。F407VET6最小系统板价格也就二十多块性价比完全能接受。提示如果你只是做最简单的五路数字灰度循迹F103确实够用。但只要涉及模拟灰度加权、速度闭环、多传感器融合直接上F407VET6会省掉后面很多“推倒重来”的麻烦。2.2 灰度循迹的三种主流方案对比在动手写代码之前我把常见的灰度循迹方案梳理了一遍实际也逐一试过。这里做个对比方便你根据自己需求选。方案原理优点缺点适用场景纯阈值开关法每路灰度设阈值输出0/1按组合查表控制代码极简响应快偏差离散弯道抖动大无法精细调速低速、简单赛道位置式PID用加权偏差作输入PID输出直接给电机PWM偏差连续直线稳积分饱和风险弯道响应偏慢中速、常规赛道增量式PIDPID输出增量叠加到当前PWM抗积分饱和切换平滑参数整定稍复杂中高速、多弯赛道我最终选的是灰度加权偏差 增量式PID再叠加一层基于偏差大小的动态速度规划这部分借鉴了模糊控制的思想用简单的规则表实现。为什么这么组合因为纯位置式PID在弯道入口容易出现“迟滞”——偏差已经很大了输出还在慢慢爬而增量式PID对偏差变化的响应更直接配合动态降速弯道通过性明显更好。2.3 整体控制框图与数据流整个系统的数据流是这样的五路灰度传感器模拟输出→ ADC多通道扫描 → 归一化处理 → 加权计算横向偏差 → 偏差送入增量式PID → 输出转向修正量 → 与基础速度合成左右轮目标速度 → 编码器速度闭环 → PWM输出到TB6612 → 电机执行。这里有个关键设计转向修正量和基础速度是解耦的。基础速度由偏差大小动态决定偏差大就降速转向修正量由PID单独算。这样直线段可以跑满速弯道自动减速不需要人为切换模式过渡很自然。3. 灰度传感器布局与偏差计算的核心细节3.1 五路灰度的物理布局与间距选择灰度传感器的布局直接决定了偏差计算的精度。我用的是五路模拟灰度模块传感器间距设成12mm中间那路对准车体中轴线。为什么是12mm这跟黑线宽度有关。我的赛道黑线宽约18mm如果传感器间距太大会出现“两路同时压线但中间空着”的情况偏差计算就会跳变间距太小五路挤在一起外侧传感器在弯道又来不及反应。实际调试下来传感器间距略小于黑线宽度是比较稳妥的这样任意时刻至少有一到两路能稳定压线加权偏差连续。我用12mm配18mm线宽实测偏差曲线很平滑。传感器的离地高度也有讲究。太高灰度值区分度不够黑白差异小太低容易刮蹭赛道。我最终定在离地8mm配合模块上的可调电位器把白底读数调到约300012位ADC黑线读数约800对比度足够。3.2 模拟灰度归一化让阈值不再“看心情”很多人用灰度模块直接读数字量省事但坑多。最大的问题是环境光一变阈值就废了。室内灯光、赛道反光、电池电压下降都会让固定阈值失效。所以我坚持用模拟量并且做归一化。归一化的思路很简单每次上电或者按按键时让小车在黑白区域各采样一次记录每路的最大值白和最小值黑然后实时读数按这个范围映射到0到1000。// 灰度归一化示例简化版 #define GRAY_CHANNELS 5 uint16_t gray_white[GRAY_CHANNELS]; // 白底标定值 uint16_t gray_black[GRAY_CHANNELS]; // 黑线标定值 uint16_t gray_norm[GRAY_CHANNELS]; // 归一化结果 0~1000 void gray_normalize(uint16_t *raw) { for (int i 0; i GRAY_CHANNELS; i) { if (gray_white[i] gray_black[i]) { gray_norm[i] 0; continue; } int32_t val (int32_t)(raw[i] - gray_black[i]) * 1000 / (gray_white[i] - gray_black[i]); if (val 0) val 0; if (val 1000) val 1000; gray_norm[i] (uint16_t)val; } }这样处理后不管环境光怎么变只要黑白对比还在归一化结果就稳定。实测在室内日光灯和窗边自然光下切换偏差计算几乎不受影响。注意标定时一定要让小车静止并且每路传感器都完整覆盖黑线和白底。我见过有人标定时小车还在动结果标定值全是错的后面怎么调都跑不直。3.3 加权偏差计算把五路信号变成一个连续偏差归一化之后下一步是把五路信号合成一个横向偏差值。最常用的方法是加权平均。给每路传感器分配一个位置权重比如从左到右是-2、-1、0、1、2然后用归一化值作权重算加权和再除以总和。// 加权偏差计算 float gray_get_error(void) { const int weight[GRAY_CHANNELS] {-2, -1, 0, 1, 2}; int32_t sum_val 0; int32_t sum_weight 0; for (int i 0; i GRAY_CHANNELS; i) { sum_val (int32_t)gray_norm[i] * weight[i]; sum_weight gray_norm[i]; } if (sum_weight 0) { return last_error; // 全丢线保持上次偏差 } return (float)sum_val / (float)sum_weight; }这个偏差范围大约在-2到2之间0表示正中。相比纯阈值法只能输出-2、-1、0、1、2五个离散值加权偏差是连续的PID输入更平滑直线段几乎不抖。这里有个细节当所有传感器都读到黑线比如十字路口或者都读到白底丢线时sum_weight会异常。我的处理是全黑时保持上次偏差并进入“路口直行”状态全白时进入“丢线搜索”状态让小车按最后已知方向慢速旋转找线。3.4 传感器安装的机械误差与补偿别小看机械安装。我第一版把灰度模块用热熔胶随便粘在车头结果五路传感器高度不一致最左边那路比右边高了两毫米导致同样白底读数差了近500。后来改用3D打印的支架保证五路传感器共面并且中轴线严格对准车体中心。如果你没有3D打印条件用亚克力板加铜柱也行关键是保证共面和中轴对称。装好后可以用一张白纸在传感器下方缓慢移动观察五路读数变化是否同步不同步就说明有机械偏差需要在归一化时做单路补偿。4. 增量式PID在循迹中的实现与调参实录4.1 位置式PID和增量式PID到底差在哪先把这个概念说清楚因为很多人调参调不明白根源是没搞懂两者区别。位置式PID的输出直接是控制量公式是u(k) Kp·e(k) Ki·Σe(i) Kd·[e(k) - e(k-1)]它有个累加项积分会一直累积。在循迹场景里如果小车长时间偏向一侧积分项会越积越大等回到中线时输出还降不下来就会冲过头这就是积分饱和。增量式PID输出的是控制量的增量Δu(k) Kp·[e(k) - e(k-1)] Ki·e(k) Kd·[e(k) - 2e(k-1) e(k-2)]然后 u(k) u(k-1) Δu(k)。它没有累加和天然抗积分饱和而且当偏差突变时增量响应更直接。循迹这个场景偏差是连续变化的而且经常出现“长时间偏一侧”的情况比如大弯道所以我选增量式。实测下来增量式在弯道入口的响应比位置式快大概一到两个控制周期别小看这点时间高速下就是压线和冲出去的区别。4.2 增量式PID代码实现可直接移植下面是我在F407VET6上实际用的增量式PID代码结构很清晰可以直接搬到你的工程里。typedef struct { float Kp; float Ki; float Kd; float e0; // 当前偏差 float e1; // 上次偏差 float e2; // 上上次偏差 float out; // 当前输出 float out_max; // 输出限幅 float out_min; } IncPID; void inc_pid_init(IncPID *pid, float kp, float ki, float kd, float out_min, float out_max) { pid-Kp kp; pid-Ki ki; pid-Kd kd; pid-e0 pid-e1 pid-e2 0.0f; pid-out 0.0f; pid-out_min out_min; pid-out_max out_max; } float inc_pid_calc(IncPID *pid, float error) { pid-e0 error; float delta pid-Kp * (pid-e0 - pid-e1) pid-Ki * pid-e0 pid-Kd * (pid-e0 - 2.0f * pid-e1 pid-e2); pid-out delta; if (pid-out pid-out_max) pid-out pid-out_max; if (pid-out pid-out_min) pid-out pid-out_min; pid-e2 pid-e1; pid-e1 pid-e0; return pid-out; }注意几个点输出限幅一定要做否则一旦参数偏大输出会飙到离谱的值e1和e2的更新顺序不能错必须在计算完delta之后、返回之前更新。4.3 参数整定的实操顺序先P再D最后碰I调参这块我踩过的坑最多。网上很多教程一上来就让你“试凑”但试凑也有章法。我的顺序是第一步只开KpKi和Kd置零。从小往大加观察小车直线段是否稳定。Kp太小小车反应迟钝弯道冲出去Kp太大直线段开始高频抖动像得了帕金森。找到“刚好不抖”的值再往回退10%到20%。第二步加Kd抑制超调。Kd的作用是“预判偏差变化趋势”偏差变化快时给一个反向修正。循迹里Kd很关键它能明显减少弯道出口的过冲。从0开始慢慢加加到小车过弯后能快速回正又不振荡为止。第三步最后才考虑Ki。增量式PID的Ki其实作用有限因为循迹偏差大部分时间是围绕0波动的积分项意义不大。我最终的Ki设得很小甚至在某些赛道上直接置零。如果你的小车总是存在一个固定方向的稳态误差比如总往左偏一点可以加一点点Ki来消除。我最终的一组参数供参考你的车不同要重调Kp18.0Ki0.0Kd6.5输出限幅±400对应PWM占空比修正量。提示调参时一定要用串口实时输出偏差和输出值光靠眼睛看小车跑很多细节看不出来。我用VOFA上位机把偏差曲线画出来一眼就能看出是超调还是响应慢。4.4 控制周期怎么定别让PID“跑太快”控制周期不是越短越好。我一开始把PID放在主循环里循环多快就跑多快结果周期不稳定有时候200微秒有时候因为OLED刷新变成2毫秒PID输出跟着乱跳。后来改成定时器中断里固定周期执行用TIM6做1ms中断每2ms执行一次PID计算也就是500Hz控制频率。这个频率对直流减速电机来说足够了再高也没意义因为电机机械响应跟不上。// TIM6中断回调2ms周期 void HAL_TIM_PeriodElapsedCallback(TIM_HandleTypeDef *htim) { if (htim-Instance TIM6) { pid_tick; if (pid_tick 2) { // 每2ms执行一次 pid_tick 0; float error gray_get_error(); float turn inc_pid_calc(track_pid, error); motor_set_target(turn); } } }固定周期还有个好处PID参数的可复现性大大提升。同样的参数在不同代码结构下表现一致方便你对比调参效果。5. 动态速度规划与模糊控制思想的落地5.1 为什么直线和弯道不能用同一个速度这是循迹优化的一个关键认知。直线段偏差接近0小车可以跑满速弯道偏差大如果还保持满速离心力和转向延迟会让小车直接冲出去。所以速度必须跟着偏差走。最简单的做法是分段偏差绝对值小于0.5跑高速0.5到1.2跑中速大于1.2跑低速。但分段会有突变小车在速度切换点会“顿”一下。更平滑的做法是用连续函数映射或者用模糊控制的规则表。5.2 用规则表实现轻量级模糊速度控制完整模糊控制器对这个小车来说太重了但模糊控制的思想很好用把偏差和偏差变化率模糊化查规则表得到速度调整量。我用了一个简化版只对偏差大小做模糊分级规则表如下。偏差绝对值速度等级基础PWM0 ~ 0.3高速72000.3 ~ 0.8中高速62000.8 ~ 1.4中速50001.4 ~ 2.0低速3800 2.0极低速3000但直接查表还是会有跳变我在等级之间做了线性插值让速度连续过渡。这样小车在进入弯道时是平滑减速出弯平滑加速没有顿挫感。// 动态基础速度计算带线性插值 float speed_schedule(float abs_error) { const float err_pt[5] {0.0f, 0.3f, 0.8f, 1.4f, 2.0f}; const float spd_pt[5] {7200, 6200, 5000, 3800, 3000}; if (abs_error err_pt[0]) return spd_pt[0]; if (abs_error err_pt[4]) return spd_pt[4]; for (int i 0; i 4; i) { if (abs_error err_pt[i1]) { float ratio (abs_error - err_pt[i]) / (err_pt[i1] - err_pt[i]); return spd_pt[i] ratio * (spd_pt[i1] - spd_pt[i]); } } return spd_pt[4]; }这套逻辑跑下来直线段能保持高速弯道自动降到合适速度整体圈速比固定速度方案快了将近四成而且稳定性更好。5.3 左右轮目标速度的合成有了基础速度和PID转向修正量左右轮目标速度就好算了void motor_set_target(float turn) { float abs_err fabsf(track_pid.e0); float base speed_schedule(abs_err); float left_target base - turn; float right_target base turn; // 限幅防止负速度或超上限 if (left_target 0) left_target 0; if (right_target 0) right_target 0; if (left_target 7200) left_target 7200; if (right_target 7200) right_target 7200; encoder_set_target(left_target, right_target); }这里turn为正表示偏差偏右需要左轮加速右轮减速来纠正。符号方向要根据你的传感器权重定义确认搞反了小车会越偏越远。5.4 速度闭环编码器反馈不能省如果只做开环PWM输出电池电压一降同样PWM下电机转速就变了循迹表现会随电量波动。所以我加了编码器速度闭环用定时器的编码器模式读霍尔编码器脉冲每20ms算一次实际速度再用一个PI控制器调整PWM。速度环的PI参数比位置环好调得多Kp8.0Ki0.5左右就能跟得不错。加了速度闭环后小车从满电跑到低压循迹表现几乎一致这点对巡检应用很重要。6. 常见问题与排查技巧实录6.1 小车画龙、左右摇摆这是最常见的现象。原因通常有三个Kp太大、Kd太小、控制周期不稳定。排查顺序是先确认控制周期是否固定用示波器或翻转IO测再降Kp再加Kd。如果降Kp后小车反应变迟钝但还在摆那就是机械问题检查传感器安装是否松动、轮子是否打滑。6.2 弯道冲出去直线正常说明转向修正量不够或者速度没降下来。先检查动态速度规划是否生效用串口打印偏差和基础速度看弯道时速度有没有降。如果速度降了还冲出去就是Kp偏小或者输出限幅太小适当加大。6.3 十字路口和丢线处理异常全黑十字时如果继续用加权偏差sum_weight会很大但偏差接近0小车会直行这通常没问题。但如果路口是T型或者有缺口就需要状态机介入。我的做法是全黑持续超过50ms进入“路口直行”状态强制偏差为0跑一段全白持续超过30ms进入“丢线搜索”按最后偏差方向慢速旋转。6.4 电池电压下降后表现变差这是开环控制的通病。解决办法就是加编码器速度闭环或者至少做电池电压补偿ADC测电池电压PWM按比例补偿。我推荐直接上速度闭环一劳永逸。6.5 常见问题速查表现象可能原因排查方法解决直线抖动Kp大/Kd小串口看偏差曲线降Kp加Kd弯道冲出速度未降/Kp小打印基础速度调速度表/加Kp单侧偏传感器机械偏差白纸测试五路读数归一化补偿表现随电量变差开环控制测电池电压加速度闭环路口乱转无状态机观察全黑全白加路口/丢线状态提示调试时一定要把关键变量通过串口输出用VOFA或者类似上位机画曲线。肉眼观察小车跑动会漏掉很多细节曲线一看就明白问题在哪。7. 我在实际优化中的几点体会这套循迹系统从最初“能跑就行”到后来“跑得稳跑得快”中间改了很多版。最大的体会是灰度循迹的优化七分在传感器数据处理三分在控制算法。很多人一上来就死磕PID参数但如果偏差计算本身是跳变的、不连续的再好的PID也救不回来。先把归一化和加权偏差做扎实PID调参会顺利很多。另一个体会是动态速度规划的价值被严重低估。我一开始也觉得循迹就是转向控制速度固定就行。后来把速度跟着偏差走之后圈速和稳定性同时提升才意识到速度规划其实是循迹性能的另一个维度。用简单的规则表加线性插值就能实现不需要复杂的模糊控制器。最后说个后续可以扩展的方向如果巡检小车要跑不同材质的赛道可以把归一化标定做成按键触发或者上电自动标定再配合偏差变化率做自适应参数调整。我试过用偏差变化率动态微调Kd在粗糙地面和光滑地面上都能有不错的表现这块后面可以单独展开聊。