简介智能寻迹小车是51单片机应用中的经典实战项目这份工程面向电子爱好者、高校学生及课设人群以C51语言实现小车沿黑白轨迹自主循线行驶覆盖传感器检测、IO读写、电机控制与转向算法等完整开发链路。资源压缩包共7个文件内含两个C源码文件、两张效果图png/jpg、一个README说明文档及许可证文件整体仅2.16MB结构精简便于快速上手。源码采用初始化、主循环加中断服务的分层设计通过红外反射传感器采集地面颜色信号并借助逻辑判断或PID策略实时修正行驶方向配套图片和文档能帮助理解硬件接线、调试参数与故障排查要点。已有255人学习浏览适合初次接触单片机项目或需要课程设计参考的读者直接借鉴与二次开发。整体而言整个工程麻雀虽小五脏俱全对理解嵌入式系统开发流程有直接的示范价值。1. 从一条黑线谈起的51单片机寻迹小车智能寻迹小车是C51课程设计里出现频率最高的项目之一拿到一份带源码的工程包并不难难的是把SmartTracingCar.c里那一堆sbit定义和延时函数变成真正能稳定跑完一圈的车。很多初学者把程序烧进单片机后遇到同一个问题车在低速时能走一旦提速就冲出赛道或在地砖反光处反复打转。我拆过不少这类项目包问题往往不在代码逻辑而在传感器阈值、电机死区和PWM频率之间的配合。这篇内容用51单片机最小系统、红外反射传感器和直流减速电机硬件逐层拆解寻迹算法从“遇到黑线就转弯”到“比例舵量输出”的演进。适合正在做51单片机课程设计的学生也适合刚接触嵌入式控制、想理解简单反馈系统怎么落地的工程师。理解这一套再往上做60°弯和十字路口都会轻松一些。2. 硬件选型与传感器信号链先懂反光率再写程序2.1 红外反射式传感器为什么是首选市面上常见的寻迹模块有红外对管、光敏电阻阵列、摄像头三类。对51单片机而言红外反射式传感器性价比最高实时性也足够。它的核心是TCRT5000一颗红外发射管加一颗光电三极管对同色表面的反光能力非常敏感。白色表面反射大部分红外光光电三极管导通比较器输出低电平黑色线条吸收红外光接收管截止比较器输出高电平。这个高低电平直接成为单片机I/O口可读的数字量省去ADC采样。打开SmartTracingCar.c之前先确认模块输出格式。有些模块可调电位器改变灵敏度有些是数字输出。数字输出模式下程序只需要读P1或P3口的几个引脚。模块自带的LM393比较器比直接用ADC分散采集成品率高互不干扰。下面是一份典型输入输出对照地面状态红外接收状态比较器输出单片机读到白色赛道导通反射强低电平0黑色引导线截止反射弱高电平1这个关系看起来简单却是后续所有寻迹逻辑的基准。如果模块是反逻辑输出只需把代码里的判断条件取反。2.2 电机驱动与电源分配驱动板最常用的是L298N优点是便宜、电流余量足缺点是想跑得细腻需要给使能脚EN提供PWM而不能只是接高电平。对于自制小车我更推荐带有光耦隔离的L298N模块能避免电机反向电动势烧单片机I/O。接线时注意共地单片机电源地和电机驱动电源地必须连在同一个参考点否则传感器信号会漂。电源方案常见两种一是两节18650电池共7.4V直接给L298N再用LM2596降压模块输出5V给51单片机二是用9V电池不稳定拉载明显只适合桌面空转。给传感器供电最好从5V稳压后引不要从L298N的5V输出口接因为那个口只是内部78M05给逻辑供电电流余量不大。若传感器阵列多于5路建议单独用一块AMS1117-5V。2.3 根据源码引脚定义确认硬件约束接收到的项目包里一般会有一个SmartTracingCar.c开头部分就是引脚草图。实际烧录前要逐行核对因为不同车型的P2口连接顺序不同。常见分配是sbit sensor_left P1^0; // 左外侧传感器 sbit sensor_center P1^1; // 中间传感器 sbit sensor_right P1^2; // 右外侧传感器 sbit motor1_in1 P2^0; // L298N输入1 sbit motor1_in2 P2^1; // L298N输入2 sbit motor2_in3 P2^2; // L298N输入3 sbit motor2_in4 P2^3; // L298N输入4这里sbit是C51扩展的关键字作用是把一个位变量绑定到具体引脚地址上。P1^0表示P1口的第0位不是异或运算。定义好之后后面所有if (sensor_left 0)都是在直接读引脚电平。接线原则是传感器排布方向垂直于行驶方向中心距建议不超过1.5cm否则黑线会从两路传感器之间漏过去造成检测空白区。L298N的ENA/ENB接到单片机定时器输出引脚比如P3^4和P3^5配合硬件PWM或软件模拟PWM来实现差速。3. C51程序骨架初始化、主循环与中断响应3.1 主循环里的有限状态机多数寻迹程序不需要复杂的数据结构一个while(1)加几个if就能跑起来。但为了让代码框架更接近真实工程我建议把状态划分为“直行”“左转”“右转”“停车”四类用一个无符号字符变量保存当前状态。程序主循环先读传感器值再映射到偏差值最后驱动电机。下面是一段可编译的C51核心代码假设三路传感器黑线上为1白色地面为0#include reg51.h sbit sensor_left P1^0; sbit sensor_center P1^1; sbit sensor_right P1^2; sbit motor1_in1 P2^0; sbit motor1_in2 P2^1; sbit motor2_in3 P2^2; sbit motor2_in4 P2^3; sbit pwm_left P3^4; // 左电机使能PWM sbit pwm_right P3^5; // 右电机使能PWM #define LEFT_FORWARD() {motor1_in11; motor1_in20;} #define LEFT_STOP() {motor1_in10; motor1_in20;} #define RIGHT_FORWARD() {motor2_in31; motor2_in40;} #define RIGHT_STOP() {motor2_in30; motor2_in40;} void delay_ms(unsigned int ms) { unsigned int i, j; for (i 0; i ms; i) for (j 0; j 120; j); } void motor_set(unsigned char left_speed, unsigned char right_speed) { // 这里只是占位真正的PWM由中断生成 pwm_left 1; // 示意 pwm_right 1; } void main(void) { unsigned char state 0; while (1) { if (sensor_left 0 sensor_center 1 sensor_right 1) { state 1; // 车偏右需要左转 } else if (sensor_left 1 sensor_center 0 sensor_right 1) { state 0; // 中间直行 } else if (sensor_left 1 sensor_center 0 sensor_right 0) { state 2; // 车偏左需要右转 } else { state 0x03; // 可能出线或十字路口保持直行 } switch (state) { case 0: motor_set(60, 60); break; case 1: motor_set(30, 60); // 降低左轮速度向右转向 break; case 2: motor_set(60, 30); break; default: motor_set(60, 60); break; } delay_ms(5); // 简单防抖 } }这段代码没有用实时PWM只通过设置pwm_left高低电平示意目的是先建立逻辑。delay_ms(5)是防抖的土办法能避免传感器电平在临界点抖动导致电机频繁换向。缺点是一旦延时时间过长转向响应会延迟。实际项目里应该把这段延时改成采样周期定时在定时器中断里读传感器。sensor_left 0表示读到了白色地面这是按2.1节的逻辑表写的。如果你的模块输出相反要么在程序里加#define BLACK 0这类宏要么把整个判断条件反转。不要在代码里混着用否则调试时脑子会绕晕。3.2 定时器中断里做真正PWM为了让电机速度可控51单片机常用定时器产生软件PWM。把定时器0设置为模式116位定时中断时间设为100μs对应PWM周期就是10kHz人耳已经听不到明显的电机啸叫。占空比通过两个全局变量控制unsigned char pwm_duty_left 60; // 0-100 unsigned char pwm_duty_right 60; unsigned char pwm_cnt 0; void timer0_isr(void) interrupt 1 { TH0 0xFF; TL0 0x9C; // 100us 12MHz pwm_cnt; if (pwm_cnt 100) { pwm_cnt 0; } if (pwm_cnt pwm_duty_left) { pwm_left 1; } else { pwm_left 0; } if (pwm_cnt pwm_duty_right) { pwm_right 1; } else { pwm_right 0; } }中断里比较pwm_cnt和占空比变量每次溢出后自动恢复周期。TH0 0xFF; TL0 0x9C是在12MHz晶振下算出的100μs定时常数。如果晶振是11.0592MHz这个值会有微小偏差但对电机控制影响不大。真正的motor_set函数只需要修改pwm_duty_left和pwm_duty_right两个全局变量中断会自动调整电机电压。这样可以避免在主循环里频繁操作I/O口造成的时序抖动。采集传感器时建议在中断外完成因为中断服务函数要尽量短不然会影响进度。3.3 传感器滤波连续读三次读传感器不能只读一次尤其是小车跑在磨砂地面上时红外信号会出现几十毫秒的毛刺。常见做法是连续读三次相同结果才确认有效。注意这个“三次”不是延时三次而是用循环快速读unsigned char read_sensor(unsigned char pin) { unsigned char count 0; unsigned char i; for (i 0; i 3; i) { if (pin 1) { count; } } if (count 2) { return 1; } else { return 0; } }函数里直接用pin 1比较位变量C51编译器会转成JB/JNB指令执行效率比函数传参高。这个滤波会带来约几十微秒的延迟对低速小车完全可接受。如果使用这种滤波主循环里的delay_ms(5)可以去掉改成固定周期触发采样更合适。4. 转向控制从规则到PID位置误差才是关键4.1 用权重法把传感器状态变成连续误差三点式传感的if-else只能得到有限状态带来的问题是小车转向角度是跳变的过弯时会走折线。更高级的做法是把传感器阵列的位置映射成一个数值误差用这个误差驱动差速。我用编号加权重的方式实现传感器状态左中右二进制值误差值000000011201020011311004-2101501106-111170这里约定车偏右时误差为正车偏左时误差为负。误差大小代表偏离中心的程度。程序中可以建立一个长度为8的查找表代替长串判断signed char error_table[8] {0, 2, 0, 1, -2, -1, 0, 0};主循环读取三位传感器拼成一个字节的索引signed char get_error(void) { unsigned char index 0; index | (sensor_left 2); index | (sensor_center 1); index | (sensor_right 0); return error_table[index]; }index的最低3位是传感器状态。这个查表思路比嵌套if清晰得多后续要增加更多传感器时只需扩展表格和索引位数。4.2 PID差速公式与限幅有了误差就可以用PID调整左右轮速。数字PID的形式很多寻迹小车用位置式PID就够。控制量是“舵量”加到左轮和右轮上时方向相反形成一个转向力矩signed int error; signed int integrator; signed int last_error; signed int pid_output; signed int pid_control(signed int current_error) { signed int doutput; integrator current_error; if (integrator 200) integrator 200; if (integrator -200) integrator -200; doutput current_error - last_error; last_error current_error; pid_output (int)(kp * current_error) (int)(ki * integrator) (int)(kd * doutput); if (pid_output 300) pid_output 300; if (pid_output -300) pid_output -300; return pid_output; }kp、ki、kd是浮点参数但51单片机做浮点运算会消耗很多周期所以实际工程常用整型系数。比如定义#define KP 20表示实际比例系数是20/100 0.2。C51下int是16位3600 * 20会溢出因此参数范围要算好。差速输出到占空比的映射如下pwm_duty_left base_speed - pid_output; pwm_duty_right base_speed pid_output;基础速度base_speed设为60左右最终占空比范围控制在0到100之间。若PID输出较大直接加减会越界所以给pwm_duty也做一次限幅if (pwm_duty_left 90) pwm_duty_left 90; if (pwm_duty_left 20) pwm_duty_left 20; if (pwm_duty_right 90) pwm_duty_right 90; if (pwm_duty_right 20) pwm_duty_right 20;下限设为20而不是0是为了避免电机完全停转时重启有死区。多数直流减速电机在占空比低于20%时无法克服静摩擦留一个基础电压会让响应更平顺。4.3 参数整定顺序PID不一定要三个参数都上。对于5mm黑线比例控制就够了过弯时加上微分项能抑制冲过头积分项只在长时间跑大圆弧时才明显。整定顺序我一般这样走先设ki 0, kd 0只调kp。从小开始增加直到小车在直线上不画龙。出现高频抖动说明kp偏大适当降低或增加微分。再加kd值约为kp的5倍到10倍主要抑制过弯后的振荡。积分ki选kp的1/20以下且必须有积分限幅防止停车时累积。参数表如下参数初值调节方向典型范围kp20/1000.2预热继续增加直到轻微抖动0.1-0.6ki0大圆弧走内侧推高0.005-0.02kd150/1001.5过弯回摆多则增大1.0-3.0这些值依赖传感器安装高度和轮距只能当作起点。我调过的一个三轮底盘传感器离地1.2cm最终落在kp0.35、ki0.008、kd2.0。另一个四轮底盘因为转向原理是差速而非转向轮kp要降到0.2才稳定。5. 进阶优化软启动和斜坡加速让寻迹更稳5.1 定时器中断里做速度斜坡直接给定pwm_duty会导致电机瞬间加速轮子打滑传感器瞬间丢失。软启动思路是给速度变量设置一个变化上限让占空比逐步升高。在定时器中断里增加以下代码signed int target_speed 80; static signed int real_speed 0; if (real_speed target_speed) { real_speed 2; // 每个PWM周期增加2 } else if (real_speed target_speed) { real_speed - 2; }这里real_speed是实际写入pwm_duty的变量target_speed是目标占空比。每100μs增加2%意味着从0加速到80需要约4ms肉眼看起来是平滑启动。如果电机响应慢可把步进调到1或3步进太大又会回到起步猛冲的老问题。5.2 低速过弯与高速直道切换寻迹赛道通常有直线和急弯混合单一base_speed无法兼顾。我常在主循环里检测到“双外侧传感器同时看到黑线”时判断这是十字路口或大弯道临时把target_speed降到50以下。等误差归零后再恢复80。这个策略要用一个计数器做迟滞避免速度来回切换if (sensor_left 1 sensor_right 1) { slow_count; if (slow_count 10) { target_speed 45; } } else { slow_count 0; target_speed 80; }slow_count达到10才降速可防止小车在弯道边缘因为短暂双黑而减速后又加速。这个计数器本身也起到低通滤波作用比直接判断更可靠。5.3 用按键或串口在线调整PID不烧录新程序就能调整参数是验证PID是否合理的利器。很多工程包都带了串口接收处理但很少看到专门为调参设计的协议。我常用的方案是预留两个全局变量通过串口中断改写kp和base_speedvoid uart_isr(void) interrupt 4 { unsigned char rx; if (RI) { rx SBUF; RI 0; if (rx A) kp 5; if (rx Z) kp - 5; if (rx S) base_speed 5; if (rx X) base_speed - 5; } }调试时把单片机串口接到PC发一个A就能让比例系数按固定步进变化不需要反复开盖接下载器。上面代码里kp是整型放大100倍后的值所以步进5对应0.05。串口波特率设置为9600与普通USB转TTL模块兼容。实测中只要波特率误差小于2%调参命令不会丢字节。对SmartTracingCar.c这种课程设计级的代码我并不追求一次写完所有功能而是先把死区、查表、限幅这三件事做对。剩下的速度规划完全可以通过定时器中断里的步进累加在不改动主循环的情况下自然融入这也是嵌入式控制里最值得养成的习惯。本文还有配套的精品资源点击获取
51单片机寻迹小车：从红外传感到PID控制的完整实现
简介智能寻迹小车是51单片机应用中的经典实战项目这份工程面向电子爱好者、高校学生及课设人群以C51语言实现小车沿黑白轨迹自主循线行驶覆盖传感器检测、IO读写、电机控制与转向算法等完整开发链路。资源压缩包共7个文件内含两个C源码文件、两张效果图png/jpg、一个README说明文档及许可证文件整体仅2.16MB结构精简便于快速上手。源码采用初始化、主循环加中断服务的分层设计通过红外反射传感器采集地面颜色信号并借助逻辑判断或PID策略实时修正行驶方向配套图片和文档能帮助理解硬件接线、调试参数与故障排查要点。已有255人学习浏览适合初次接触单片机项目或需要课程设计参考的读者直接借鉴与二次开发。整体而言整个工程麻雀虽小五脏俱全对理解嵌入式系统开发流程有直接的示范价值。1. 从一条黑线谈起的51单片机寻迹小车智能寻迹小车是C51课程设计里出现频率最高的项目之一拿到一份带源码的工程包并不难难的是把SmartTracingCar.c里那一堆sbit定义和延时函数变成真正能稳定跑完一圈的车。很多初学者把程序烧进单片机后遇到同一个问题车在低速时能走一旦提速就冲出赛道或在地砖反光处反复打转。我拆过不少这类项目包问题往往不在代码逻辑而在传感器阈值、电机死区和PWM频率之间的配合。这篇内容用51单片机最小系统、红外反射传感器和直流减速电机硬件逐层拆解寻迹算法从“遇到黑线就转弯”到“比例舵量输出”的演进。适合正在做51单片机课程设计的学生也适合刚接触嵌入式控制、想理解简单反馈系统怎么落地的工程师。理解这一套再往上做60°弯和十字路口都会轻松一些。2. 硬件选型与传感器信号链先懂反光率再写程序2.1 红外反射式传感器为什么是首选市面上常见的寻迹模块有红外对管、光敏电阻阵列、摄像头三类。对51单片机而言红外反射式传感器性价比最高实时性也足够。它的核心是TCRT5000一颗红外发射管加一颗光电三极管对同色表面的反光能力非常敏感。白色表面反射大部分红外光光电三极管导通比较器输出低电平黑色线条吸收红外光接收管截止比较器输出高电平。这个高低电平直接成为单片机I/O口可读的数字量省去ADC采样。打开SmartTracingCar.c之前先确认模块输出格式。有些模块可调电位器改变灵敏度有些是数字输出。数字输出模式下程序只需要读P1或P3口的几个引脚。模块自带的LM393比较器比直接用ADC分散采集成品率高互不干扰。下面是一份典型输入输出对照地面状态红外接收状态比较器输出单片机读到白色赛道导通反射强低电平0黑色引导线截止反射弱高电平1这个关系看起来简单却是后续所有寻迹逻辑的基准。如果模块是反逻辑输出只需把代码里的判断条件取反。2.2 电机驱动与电源分配驱动板最常用的是L298N优点是便宜、电流余量足缺点是想跑得细腻需要给使能脚EN提供PWM而不能只是接高电平。对于自制小车我更推荐带有光耦隔离的L298N模块能避免电机反向电动势烧单片机I/O。接线时注意共地单片机电源地和电机驱动电源地必须连在同一个参考点否则传感器信号会漂。电源方案常见两种一是两节18650电池共7.4V直接给L298N再用LM2596降压模块输出5V给51单片机二是用9V电池不稳定拉载明显只适合桌面空转。给传感器供电最好从5V稳压后引不要从L298N的5V输出口接因为那个口只是内部78M05给逻辑供电电流余量不大。若传感器阵列多于5路建议单独用一块AMS1117-5V。2.3 根据源码引脚定义确认硬件约束接收到的项目包里一般会有一个SmartTracingCar.c开头部分就是引脚草图。实际烧录前要逐行核对因为不同车型的P2口连接顺序不同。常见分配是sbit sensor_left P1^0; // 左外侧传感器 sbit sensor_center P1^1; // 中间传感器 sbit sensor_right P1^2; // 右外侧传感器 sbit motor1_in1 P2^0; // L298N输入1 sbit motor1_in2 P2^1; // L298N输入2 sbit motor2_in3 P2^2; // L298N输入3 sbit motor2_in4 P2^3; // L298N输入4这里sbit是C51扩展的关键字作用是把一个位变量绑定到具体引脚地址上。P1^0表示P1口的第0位不是异或运算。定义好之后后面所有if (sensor_left 0)都是在直接读引脚电平。接线原则是传感器排布方向垂直于行驶方向中心距建议不超过1.5cm否则黑线会从两路传感器之间漏过去造成检测空白区。L298N的ENA/ENB接到单片机定时器输出引脚比如P3^4和P3^5配合硬件PWM或软件模拟PWM来实现差速。3. C51程序骨架初始化、主循环与中断响应3.1 主循环里的有限状态机多数寻迹程序不需要复杂的数据结构一个while(1)加几个if就能跑起来。但为了让代码框架更接近真实工程我建议把状态划分为“直行”“左转”“右转”“停车”四类用一个无符号字符变量保存当前状态。程序主循环先读传感器值再映射到偏差值最后驱动电机。下面是一段可编译的C51核心代码假设三路传感器黑线上为1白色地面为0#include reg51.h sbit sensor_left P1^0; sbit sensor_center P1^1; sbit sensor_right P1^2; sbit motor1_in1 P2^0; sbit motor1_in2 P2^1; sbit motor2_in3 P2^2; sbit motor2_in4 P2^3; sbit pwm_left P3^4; // 左电机使能PWM sbit pwm_right P3^5; // 右电机使能PWM #define LEFT_FORWARD() {motor1_in11; motor1_in20;} #define LEFT_STOP() {motor1_in10; motor1_in20;} #define RIGHT_FORWARD() {motor2_in31; motor2_in40;} #define RIGHT_STOP() {motor2_in30; motor2_in40;} void delay_ms(unsigned int ms) { unsigned int i, j; for (i 0; i ms; i) for (j 0; j 120; j); } void motor_set(unsigned char left_speed, unsigned char right_speed) { // 这里只是占位真正的PWM由中断生成 pwm_left 1; // 示意 pwm_right 1; } void main(void) { unsigned char state 0; while (1) { if (sensor_left 0 sensor_center 1 sensor_right 1) { state 1; // 车偏右需要左转 } else if (sensor_left 1 sensor_center 0 sensor_right 1) { state 0; // 中间直行 } else if (sensor_left 1 sensor_center 0 sensor_right 0) { state 2; // 车偏左需要右转 } else { state 0x03; // 可能出线或十字路口保持直行 } switch (state) { case 0: motor_set(60, 60); break; case 1: motor_set(30, 60); // 降低左轮速度向右转向 break; case 2: motor_set(60, 30); break; default: motor_set(60, 60); break; } delay_ms(5); // 简单防抖 } }这段代码没有用实时PWM只通过设置pwm_left高低电平示意目的是先建立逻辑。delay_ms(5)是防抖的土办法能避免传感器电平在临界点抖动导致电机频繁换向。缺点是一旦延时时间过长转向响应会延迟。实际项目里应该把这段延时改成采样周期定时在定时器中断里读传感器。sensor_left 0表示读到了白色地面这是按2.1节的逻辑表写的。如果你的模块输出相反要么在程序里加#define BLACK 0这类宏要么把整个判断条件反转。不要在代码里混着用否则调试时脑子会绕晕。3.2 定时器中断里做真正PWM为了让电机速度可控51单片机常用定时器产生软件PWM。把定时器0设置为模式116位定时中断时间设为100μs对应PWM周期就是10kHz人耳已经听不到明显的电机啸叫。占空比通过两个全局变量控制unsigned char pwm_duty_left 60; // 0-100 unsigned char pwm_duty_right 60; unsigned char pwm_cnt 0; void timer0_isr(void) interrupt 1 { TH0 0xFF; TL0 0x9C; // 100us 12MHz pwm_cnt; if (pwm_cnt 100) { pwm_cnt 0; } if (pwm_cnt pwm_duty_left) { pwm_left 1; } else { pwm_left 0; } if (pwm_cnt pwm_duty_right) { pwm_right 1; } else { pwm_right 0; } }中断里比较pwm_cnt和占空比变量每次溢出后自动恢复周期。TH0 0xFF; TL0 0x9C是在12MHz晶振下算出的100μs定时常数。如果晶振是11.0592MHz这个值会有微小偏差但对电机控制影响不大。真正的motor_set函数只需要修改pwm_duty_left和pwm_duty_right两个全局变量中断会自动调整电机电压。这样可以避免在主循环里频繁操作I/O口造成的时序抖动。采集传感器时建议在中断外完成因为中断服务函数要尽量短不然会影响进度。3.3 传感器滤波连续读三次读传感器不能只读一次尤其是小车跑在磨砂地面上时红外信号会出现几十毫秒的毛刺。常见做法是连续读三次相同结果才确认有效。注意这个“三次”不是延时三次而是用循环快速读unsigned char read_sensor(unsigned char pin) { unsigned char count 0; unsigned char i; for (i 0; i 3; i) { if (pin 1) { count; } } if (count 2) { return 1; } else { return 0; } }函数里直接用pin 1比较位变量C51编译器会转成JB/JNB指令执行效率比函数传参高。这个滤波会带来约几十微秒的延迟对低速小车完全可接受。如果使用这种滤波主循环里的delay_ms(5)可以去掉改成固定周期触发采样更合适。4. 转向控制从规则到PID位置误差才是关键4.1 用权重法把传感器状态变成连续误差三点式传感的if-else只能得到有限状态带来的问题是小车转向角度是跳变的过弯时会走折线。更高级的做法是把传感器阵列的位置映射成一个数值误差用这个误差驱动差速。我用编号加权重的方式实现传感器状态左中右二进制值误差值000000011201020011311004-2101501106-111170这里约定车偏右时误差为正车偏左时误差为负。误差大小代表偏离中心的程度。程序中可以建立一个长度为8的查找表代替长串判断signed char error_table[8] {0, 2, 0, 1, -2, -1, 0, 0};主循环读取三位传感器拼成一个字节的索引signed char get_error(void) { unsigned char index 0; index | (sensor_left 2); index | (sensor_center 1); index | (sensor_right 0); return error_table[index]; }index的最低3位是传感器状态。这个查表思路比嵌套if清晰得多后续要增加更多传感器时只需扩展表格和索引位数。4.2 PID差速公式与限幅有了误差就可以用PID调整左右轮速。数字PID的形式很多寻迹小车用位置式PID就够。控制量是“舵量”加到左轮和右轮上时方向相反形成一个转向力矩signed int error; signed int integrator; signed int last_error; signed int pid_output; signed int pid_control(signed int current_error) { signed int doutput; integrator current_error; if (integrator 200) integrator 200; if (integrator -200) integrator -200; doutput current_error - last_error; last_error current_error; pid_output (int)(kp * current_error) (int)(ki * integrator) (int)(kd * doutput); if (pid_output 300) pid_output 300; if (pid_output -300) pid_output -300; return pid_output; }kp、ki、kd是浮点参数但51单片机做浮点运算会消耗很多周期所以实际工程常用整型系数。比如定义#define KP 20表示实际比例系数是20/100 0.2。C51下int是16位3600 * 20会溢出因此参数范围要算好。差速输出到占空比的映射如下pwm_duty_left base_speed - pid_output; pwm_duty_right base_speed pid_output;基础速度base_speed设为60左右最终占空比范围控制在0到100之间。若PID输出较大直接加减会越界所以给pwm_duty也做一次限幅if (pwm_duty_left 90) pwm_duty_left 90; if (pwm_duty_left 20) pwm_duty_left 20; if (pwm_duty_right 90) pwm_duty_right 90; if (pwm_duty_right 20) pwm_duty_right 20;下限设为20而不是0是为了避免电机完全停转时重启有死区。多数直流减速电机在占空比低于20%时无法克服静摩擦留一个基础电压会让响应更平顺。4.3 参数整定顺序PID不一定要三个参数都上。对于5mm黑线比例控制就够了过弯时加上微分项能抑制冲过头积分项只在长时间跑大圆弧时才明显。整定顺序我一般这样走先设ki 0, kd 0只调kp。从小开始增加直到小车在直线上不画龙。出现高频抖动说明kp偏大适当降低或增加微分。再加kd值约为kp的5倍到10倍主要抑制过弯后的振荡。积分ki选kp的1/20以下且必须有积分限幅防止停车时累积。参数表如下参数初值调节方向典型范围kp20/1000.2预热继续增加直到轻微抖动0.1-0.6ki0大圆弧走内侧推高0.005-0.02kd150/1001.5过弯回摆多则增大1.0-3.0这些值依赖传感器安装高度和轮距只能当作起点。我调过的一个三轮底盘传感器离地1.2cm最终落在kp0.35、ki0.008、kd2.0。另一个四轮底盘因为转向原理是差速而非转向轮kp要降到0.2才稳定。5. 进阶优化软启动和斜坡加速让寻迹更稳5.1 定时器中断里做速度斜坡直接给定pwm_duty会导致电机瞬间加速轮子打滑传感器瞬间丢失。软启动思路是给速度变量设置一个变化上限让占空比逐步升高。在定时器中断里增加以下代码signed int target_speed 80; static signed int real_speed 0; if (real_speed target_speed) { real_speed 2; // 每个PWM周期增加2 } else if (real_speed target_speed) { real_speed - 2; }这里real_speed是实际写入pwm_duty的变量target_speed是目标占空比。每100μs增加2%意味着从0加速到80需要约4ms肉眼看起来是平滑启动。如果电机响应慢可把步进调到1或3步进太大又会回到起步猛冲的老问题。5.2 低速过弯与高速直道切换寻迹赛道通常有直线和急弯混合单一base_speed无法兼顾。我常在主循环里检测到“双外侧传感器同时看到黑线”时判断这是十字路口或大弯道临时把target_speed降到50以下。等误差归零后再恢复80。这个策略要用一个计数器做迟滞避免速度来回切换if (sensor_left 1 sensor_right 1) { slow_count; if (slow_count 10) { target_speed 45; } } else { slow_count 0; target_speed 80; }slow_count达到10才降速可防止小车在弯道边缘因为短暂双黑而减速后又加速。这个计数器本身也起到低通滤波作用比直接判断更可靠。5.3 用按键或串口在线调整PID不烧录新程序就能调整参数是验证PID是否合理的利器。很多工程包都带了串口接收处理但很少看到专门为调参设计的协议。我常用的方案是预留两个全局变量通过串口中断改写kp和base_speedvoid uart_isr(void) interrupt 4 { unsigned char rx; if (RI) { rx SBUF; RI 0; if (rx A) kp 5; if (rx Z) kp - 5; if (rx S) base_speed 5; if (rx X) base_speed - 5; } }调试时把单片机串口接到PC发一个A就能让比例系数按固定步进变化不需要反复开盖接下载器。上面代码里kp是整型放大100倍后的值所以步进5对应0.05。串口波特率设置为9600与普通USB转TTL模块兼容。实测中只要波特率误差小于2%调参命令不会丢字节。对SmartTracingCar.c这种课程设计级的代码我并不追求一次写完所有功能而是先把死区、查表、限幅这三件事做对。剩下的速度规划完全可以通过定时器中断里的步进累加在不改动主循环的情况下自然融入这也是嵌入式控制里最值得养成的习惯。本文还有配套的精品资源点击获取
