1. 从“疯狂左转”说起:PID调参才是循迹小车上最难的一道坎
如果你刚把STM32循迹小车的代码烧进去,满怀期待地放到跑道上按下电源,结果小车不是冲出去,而是原地“啪”地一下猛转左轮、整台车像个陀螺一样原地转圈,或者直接一头扎向赛道外边,一路往左狂奔,那恭喜你,你正在经历每个做循迹小车的人都会遇到的第一道坎。
我当年第一次调PID时,小车在测试台上疯狂左转,电机转速拉满,差点把电池线甩断。当时我一度以为是硬件接错了、传感器坏了、甚至怀疑是不是地磁干扰——折腾了两天之后才意识到:不是车坏了,是PID参数和逻辑方向压根没配对。
这篇博文要解决的问题,就是把你从“疯狂左转”带到“完美跑圈”。我会从PID的控制原理讲起,落在增量式PID的具体实现代码上,然后重点讲调参的完整思路和排查链路。全程用STM32标准库风格的C代码,移植到HAL库也只需要把底层的PWM和ADC接口换掉即可。
适合谁看?正在做STM32循迹小车毕业设计/课程设计的学生,玩智能车竞赛准备入门PID的新手,以及那种“代码跑起来了但车就是不走直线”的苦手。如果你已经会调P但车还是晃动、过弯甩尾,那从第6章开始看也行。
先说个结论,避免你走弯路: 循迹小车PID调参,本质上是“感知、决策、执行”三个环节的匹配问题 。90%的“疯狂左转”不是算法理论没搞懂,而是传感器映射、电机方向、PWM输出极性这三者中有至少一项和PID逻辑反了。这个后面会展开讲。
2. 控制链路拆解:灰度传感器、STM32、电机之间到底在传递什么
2.1 为什么不用继电器式开关控制,非得用PID
很多新手第一次写循迹逻辑,用的都是最简单粗暴的方式:
- 传感器在线的左边,就往右转;
- 传感器在线的右边,就往左转;
- 都在线中间,就直走。
这种逻辑在低速、大弯道、宽黑线、传感器间距合适的情况下确实能跑。但只要车速稍微提起来一点,小车就会在线的两侧来回“画龙”,越画越夸张,最后冲出去。
原因很简单:开关控制只有两个状态——“转”和“不转”。它不关心自己偏了多少,只知道“偏了”,然后以最大力度修正。于是必然过冲,冲过头了又反向修正,又过冲。这就是典型的振荡,而且随着速度提高,振荡频率越来越高,最终失控。
PID做的事情本质上就是给这个“修正动作”打分:偏得少就少修正,偏得多就多修正,而且在接近回正时提前减速,避免冲过头。它让“决策”和“偏差量”成正比,而不是只给定性的“有/无”。
2.2 传感器选型与安装布局
循迹小车最常见的传感器方案有两种:
| 方案 | 传感器类型 | 输出方式 | 优点 | 缺点 |
|---|---|---|---|---|
| 数字量方案 | TCRT5000红外反射模块(带比较器) | 0/1 | 简单,直接读GPIO | 只有“黑/白”两态,偏差分辨率低 |
| 模拟量方案 | 灰度传感器(光敏电阻或自制红外对管) | ADC电压值 | 可以插值计算精确位置 | 电路复杂,校准麻烦 |
如果你只是让车能跑圈,TCRT5000做一排8路数字量就够用。如果你想让车跑得丝滑、过弯不掉线,推荐至少5路以上。我自己的车用的是8路,间距1.5cm,探头离地约1cm。传感器离地高度非常关键:太近了容易刮到地面凸起,太远了黑白差异值变小,容易误判。
安装布局上有个我踩过的坑:传感器排布宽度要跟跑道黑线宽度匹配。如果黑线2cm宽,你8个探头间隔1.5cm,那黑线最多覆盖1-2个探头,中间几个探头永远在白色地面上,这样整个偏差映射就废了。一般原则是: 传感器总覆盖宽度略大于黑线宽度的1.5倍左右 ,保证小车在较大偏移时仍有探头在线内。
2.3 误差信号是如何生成的:从8路0/1到连续偏差值
PID的输入是一个连续变化的偏差量,但TCRT5000数字量输出只有0和1,怎么变成连续值?两种办法:
办法A:加权映射
给每个探头一个权重,正中间是0,越靠左权重越负,越靠右权重越正。比如8路探头的权重可以设为[-4, -3, -2, -1, 1, 2, 3, 4](注意中间两个不要设0和0,留一个小盲区,也可以设-1和1)。
每次读取后,把所有在线内的探头权重加总,除以在线探头数,得到一个平均位置。公式写一下:
float getError(uint8_t *sensors, uint8_t num)
{
int weight_sum = 0;
int on_count = 0;
int16_t weights[8] = {-4, -3, -2, -1, 1, 2, 3, 4};
for (int i = 0; i < num; i++) {
if (sensors[i] == ON_LINE) { // 探头压到黑线
weight_sum += weights[i];
on_count++;
}
}
if (on_count == 0) {
// 丢线了,返回一个超大偏差,稍后讲
return last_error * 1.5f;
}
return (float)weight_sum / on_count;
}
这个error就是PID的输入:正数代表车偏右,需要往左转;负数代表车偏左,需要往右转。绝对值越大,偏得越多。
办法B:模拟量插值
如果传感器输出的是模拟值,你可以通过“重心法”算出更精细的位置,公式为:
float getCentroid(uint16_t *adc_values, uint8_t num) {
float numerator = 0.f;
float denominator = 0.f;
for (int i = 0; i < num; i++) {
float val = (float)adc_values[i];
numerator += val * i * SENSOR_SPACING_CM;
denominator += val;
}
if (denominator < 1e-6f) return 0.f;
return numerator / denominator;
}
这两种办法的核心思路都一样:把多个传感器的状态量化成一个连续数值,数值的正负和大小直接反映小车相对于黑线的位置偏差。
2.4 执行器端:PWM占空比和转向的关系
执行器是两路直流减速电机,通过TB6612或L298N驱动。PID算出来的是一个“转向控制量”,要把它变成左右电机的PWM占空比。
基础映射方式:
1万+



被折叠的 条评论
为什么被折叠?



