【STM32最小系统板】从状态机到PID：细铁丝高速循迹小车的算法演进与实践-平芜编程栈

1. 细铁丝循迹小车的技术挑战

用STM32最小系统板做循迹小车的朋友，应该都玩过黑胶带或白线循迹。但当我第一次接触0.6mm细铁丝循迹时，才发现这完全是另一个维度的挑战。就像用毛笔写字和用绣花针刻字的区别——前者允许一定误差，后者稍有不慎就会失控。

细铁丝带来的核心难题有三个：首先是检测精度，普通红外对管在1cm黑线上的检测方式完全失效，必须改用涡流传感器或高灵敏度霍尔元件；其次是控制响应速度，当小车以400mm/s以上速度行驶时，传统延时转向方案会让小车像醉汉一样走S形路线；最后是机械适配性，我曾亲眼见证某参赛队伍因为车轮轴承的0.1mm间隙，导致直线行驶时持续偏航。

这里有个实测数据对比：同样使用四路传感器时，1cm黑线循迹的容错宽度约为±5mm，而0.6mm铁丝的允许偏差仅有±0.8mm。这意味着传感器安装角度偏差超过2度，或者车体震动幅度大于1mm，都会导致循迹失败。这也是为什么很多队伍初期用状态机方案时，小车总在转弯处"飞"出赛道。

2. 状态机：从混沌到有序的进化

2.1 传统延时方案的致命缺陷

最早我做黑线循迹时，用的就是典型的延时逻辑：

void xunji() { if(左传感器触发){ 左转(); delay(10); // 魔法数字 } else if(右传感器触发){ 右转(); delay(8); // 另一个魔法数字 } }

这种方案在细铁丝场景下会暴露两个致命问题：一是delay时间需要根据速度动态调整，速度提升10%就可能需要重新校准所有参数；二是没有状态记忆，当传感器因震动短暂误触发时，小车会像无头苍蝇一样乱转。

2.2 五状态机的实战实现

升级后的状态机方案引入了行驶状态记忆，就像给盲人配了导盲杖：

enum State { RapidLeft = -2, // 急左转 TurnLeft = -1, // 普通左转 Straight = 0, // 直行 TurnRight = 1, // 普通右转 RapidRight = 2 // 急右转 };

关键改进在于状态切换逻辑：

if (Left1==0 && Left2==1 && Right1==1) { st = RapidLeft; // 左前轮压线需要急转 } else if (Left1==1 && Left2==1 && Right1==0) { st = RapidRight; } else if (st == TurnLeft && 所有传感器==1) { st = Straight; // 仅当从转弯状态恢复时才切回直行 }

实测表明，加入状态记忆后，在半径20cm的弯道上通过率从38%提升到92%。但新的问题出现了——当速度超过500mm/s时，小车在直线段会出现持续振荡。

3. PID控制：让小车学会"自动驾驶"

3.1 增量式PID的落地实践

状态机解决了转弯问题，但直线稳定性需要PID出场。我选择增量式PID主要考虑三点：计算量小（STM32F103C8T6资源有限）、抗积分饱和（避免长时间偏离导致的失控）、参数易调（比赛时间紧迫）。

具体实现时有几个关键点：

int Incremental_PI(int Encoder, int Target) { static float error, Last_error, Last_Last_error; error = Target - Encoder; Pwm += Kp*(error-Last_error) + Ki*error; // 增量计算 Last_Last_error = Last_error; Last_error = error; return Pwm; }

参数调节时有个小技巧：先用示波器观察编码器波形，将P值从小往大调，直到出现等幅振荡，此时取该值的60%作为最终P值。比如我测试时振荡临界P=5.3，实际采用P=3.2。

3.2 速度与位置的串级控制

高阶玩法是结合编码器速度环和传感器位置环：

[目标速度] → [PID速度控制] → [电机PWM] ↑ [编码器反馈] ← [电机转动]

同时：

[传感器位置] → [状态机] → [目标速度修正]

这种架构下，小车在直线段会保持300mm/s匀速，检测到弯道时，状态机动态修改左右轮目标速度差。实测在800mm/s高速下，仍能保持±1.5mm的循迹精度。

4. 硬件设计的魔鬼细节

4.1 传感器选型血泪史

试过三种方案后，最终选择LDC1314涡流传感器，其优势在于：

检测距离可精确到0.1mm
响应频率高达4MHz（应对高速）
数字输出避免模拟信号干扰

但要注意三个坑：

传感器线圈必须与铁丝垂直，倾斜超过10度灵敏度下降50%
铝合金底盘会形成涡流干扰，解决方案是用3mm亚克力板作支架
供电必须独立LDO，电机启停时的电压波动会导致误检测

4.2 机械结构的毫米级优化

几个关键尺寸影响巨大：

轮距建议保持90-100mm，过小易侧翻，过大转向迟钝
传感器安装高度距铁丝3±0.5mm，用尼龙螺丝方便微调
牛眼轮要选带陶瓷轴承的版本，摩擦系数降低60%

特别提醒：车轮的同心度要用百分表校准，我遇到过因为0.2mm偏心导致的速度波动问题，这种机械误差是软件无法完全补偿的。

5. 竞速模式的极限调参

当基础功能实现后，要突破20秒/圈的关键在于：

5.1 动态速度规划

弯道不是全程降速，而是采用"入弯减速-弯心加速"策略：

if(进入弯道){ Target = 常规速度 * 0.7; flag = 1; // 标记入弯 } else if(弯心 && flag){ Target = 常规速度 * 1.3; // 利用离心力加速出弯 flag = 0; }

5.2 控制周期优化

把PID计算从主循环移到定时器中断，关键配置：

void TIM4_IRQHandler() { if(TIM_GetITStatus(TIM4, TIM_IT_Update)){ LeftPwm = Incremental_PI(LeftEncoder, LeftTarget); RightPwm = Incremental_PI(RightEncoder, RightTarget); SetPwm(LeftPwm, RightPwm); TIM_ClearITPendingBit(TIM4, TIM_IT_Update); } }

定时器周期设置为5ms时，系统响应延迟从原来的120ms降到8ms，这也是能实现高速控制的基础。