基于51单片机的智能送药小车：系统设计、PID循迹与状态机实战

1. 项目概述与核心需求拆解

看到“智能送药小车”这个题目，很多参加过电赛或者正在备赛的同学应该都不陌生。这其实是2021年全国大学生电子设计竞赛（电赛）F题的控制类经典题目。我当年带学生做这个项目，从拿到赛题到最终调试完成，整个过程可以说是“痛并快乐着”。它不像一些纯算法题那么抽象，而是要求你实实在在地造出一个能跑、能看、能思考的实体小车，把单片机、传感器、电机驱动、算法逻辑这些知识点全部串起来，非常考验综合实践能力。

简单来说，这个项目的核心就是让一辆小车在模拟的医院病房走廊（通常是黑色引导线铺成的赛道）里自主行驶。它需要从“药房”出发，根据任务要求，将“药品”（通常用不同颜色或编号的物体模拟）准确送达指定的“病房”（赛道上的特定区域），并且可能需要完成一些附加动作，比如原地旋转、鸣笛提示、屏幕显示状态等。整个系统涉及循迹导航、颜色/编号识别、运动控制、任务调度等多个模块的协同工作。

为什么说它经典？因为它几乎涵盖了本科阶段电子类实践课程的所有核心：你得懂点硬件，能看懂原理图、焊接调试电路；你得会单片机编程，用C语言把各个外设驱动起来；你还得有点软件思维，把复杂的任务分解成一个个状态机或者小函数。对于新手而言，把它做通透了，单片机开发就算入门了；对于老手，如何优化路径、提升识别精度和速度，又是无尽的挑战。下面，我就结合当年的实战经验，把这辆小车的“五脏六腑”拆开揉碎了讲清楚。

2. 系统整体架构与方案选型

做任何嵌入式项目，第一步永远是顶层设计。你不能上来就埋头写代码，必须想清楚系统由哪些部分组成，它们之间如何通信。对于这辆智能送药小车，一个典型且可靠的系统架构可以划分为四层：感知层、决策层、控制层和执行层。

2.1 主控芯片选型：为什么是51单片机？

题目相关热词里反复出现“51单片机”，这几乎是电赛控制类题目的“国民芯片”。很多人可能会问，现在STM32、ESP32功能更强大，为什么还要用51？

首先，比赛导向与公平性。电赛尤其是校内选拔或省级比赛，常指定或倾向于使用51内核单片机（如STC89C52、STC12C5A60S2等），目的是考察学生对基础核心知识的掌握，避免陷入复杂芯片的库函数调用，更能体现底层编程能力。其次，资源与成本。51单片机价格低廉，开发板普及，学习资料浩如烟海，对于学生团队而言试错成本低。最后，够用原则。智能送药小车的核心任务——读取多路传感器、产生PWM控制电机、进行简单的逻辑判断——51单片机的运算能力和IO口数量完全能够胜任。使用51能把精力聚焦在算法和系统集成上，而不是折腾复杂的外设驱动。

当然，如果你选用增强型的51芯片（如STC12/15系列），它们内置了PWM发生器、更多的定时器和更快的指令周期，会让开发更轻松。我当时的方案是STC12C5A60S2，主频跑在11.0592MHz，兼顾了稳定性和速度。

2.2 传感器方案：循迹与识别

这是小车的“眼睛”，方案选对了，后面就成功了一半。

• 循迹传感器：赛道引导线通常是黑色。热词中提到了“五路循迹传感器”和“八路灰度传感器”。这里有个关键区别：数字式与模拟式。

  • 数字式（五路循迹模块）：常见的是TCRT5000红外对管模块。它输出的是数字信号（0或1），检测到黑线输出高电平，白底输出低电平（或反之，取决于电路）。优点是电路简单、编程直观，直接读IO口高低电平即可。缺点是抗环境光干扰能力较弱，且无法感知偏离轨道的程度（只知道“在线左”、“压线”、“在线右”这种离散状态）。
  • 模拟式（八路灰度传感器）：通常使用灰度传感器（如GY-31），输出的是模拟电压值，电压高低反映了地面反射光的强度。优点是能获得连续的偏差信息，结合PID算法可以实现更平滑、更精准的循迹控制。缺点是需要单片机具备多路AD转换功能（STC12系列有8路10位AD），软件上需要做AD采样和数据处理，复杂度稍高。
  • 选型建议：对于新手，从五路数字传感器入手更简单快捷，能快速搭建出可跑的系统。如果想追求更高的控制精度和速度，八路模拟灰度传感器是更好的选择，它为后续引入PID控制提供了数据基础。我们当时采用的是五路数字方案，通过合理的安装间距和阈值调整，也完全能满足要求。

• 病房与药品识别传感器：题目要求小车识别不同的病房（可能用不同颜色卡片标识）和药品（可能用不同颜色积木块）。这里颜色传感器是首选。常用的有TCS3200颜色识别模块。它通过可编程的滤光器输出频率与颜色光强成正比的方波，单片机通过测量方波频率来识别RGB分量。你需要为每个需要识别的颜色（如红、绿、蓝病房，红、黄、蓝药品）预先测量并记录其RGB特征值范围，运行时进行匹配。

2.3 执行机构：电机与驱动

小车的“腿”。最常用的是直流减速电机配车轮。电机驱动芯片的选择关乎动力和控制的精细度。

• L298N：经典的双H桥驱动芯片，可驱动两个直流电机。优点是皮实耐用、驱动电流大（单桥2A）、价格便宜。缺点是发热量较大，需要加装散热片，且逻辑控制相对简单。
• TB6612FNG：新一代的电机驱动芯片，相比L298N，效率更高、发热更小、外围电路更简单，支持更高的PWM频率。是当前更主流的选择。
• 驱动方式：必须采用PWM（脉冲宽度调制）调速。通过改变单片机输出给驱动芯片的PWM波占空比，来调节电机两端的平均电压，从而实现无级调速。这是实现小车匀速、转弯、加减速控制的基础。51单片机没有硬件PWM模块，需要用定时器中断来模拟生成，这是编程中的一个关键点。

2.4 系统架构框图

基于以上选型，我们可以画出系统的硬件架构框图（文字描述）：

1. 主控核心：STC12C5A60S2单片机。
2. 电源模块：采用7.4V或12V锂电池供电，通过LM2596等降压模块为单片机（5V）、传感器（5V/3.3V）、电机驱动（直接电池电压）提供稳定电压。电源隔离非常重要，电机启停会造成电源波动，可能使单片机复位。建议单片机电源与电机驱动电源在入口处用二极管或磁珠进行隔离。
3. 感知模块：
   • 循迹：五路TCRT5000数字传感器，接入单片机5个IO口。
   • 识别：TCS3200颜色传感器，通过IO口控制滤光器选择，通过外部中断或定时器捕获测量输出频率。
4. 执行模块：
   • 电机驱动：TB6612FNG芯片，接收单片机的PWM信号和方向控制信号，驱动两个直流减速电机。
   • 其他：蜂鸣器（任务提示）、LED指示灯（状态显示）、可能需要的舵机（用于抓取药品，本题中通常简化）。
5. 人机交互：可能包括LCD1602液晶屏（显示当前任务、状态）、按键（启动、模式选择）。

注意：硬件设计上，务必将数字地（单片机、传感器）和功率地（电机驱动、电机）单点连接，避免电机大电流噪声干扰数字电路的稳定性。所有从外部接入单片机的信号线，最好串联一个100-200欧姆的电阻，起到限流和一定程度的隔离作用。

3. 核心算法与软件设计详解

硬件是骨架，软件是灵魂。智能送药小车的软件设计核心在于状态机和控制算法。

3.1 循迹算法：从简单逻辑到PID进阶

循迹算法的目标是根据传感器阵列的数据，计算出小车应该如何转向以保持在线上。

• 基础逻辑法（适用于五路数字传感器）： 假设五路传感器从左到右为S1, S2, S3, S4, S5。中间S3为基准。常见的逻辑是：

  • S3==1：小车正在线上，直行。
  • S2==1：小车轻微左偏，轻微右转（向左修正）。
  • S4==1：小车轻微右偏，轻微左转。
  • S1==1：小车严重左偏，较大幅度右转。
  • S5==1：小车严重右偏，较大幅度左转。 这种方法实现简单，但控制是“阶跃式”的，小车运行轨迹可能是锯齿形，不流畅。

• 位置式PID控制法（适用于八路模拟传感器）： 这是更高级、更平滑的控制方法。核心思想是计算一个连续的“偏差值”。

  1. 偏差计算：将八路传感器的AD值进行加权平均，计算出一个代表车体中心与线中心偏移量的连续偏差值error。例如，给每个传感器分配一个位置权重（如-3.5, -2.5, -1.5, -0.5, 0.5, 1.5, 2.5, 3.5），乘以归一化后的传感器值（黑线处值大），再求和。
  2. PID计算：
     • P（比例）：与当前偏差error成正比，提供基本的转向力。
     • I（积分）：累积历史偏差，消除静态误差（如长期偏向一侧）。
     • D（微分）：与偏差变化率成正比，抑制振荡，提高稳定性。 输出Output = Kp * error + Ki * integral + Kd * derivative。
  3. 控制输出：将Output值映射为左右电机的PWM占空比差值。例如，Left_PWM = Base_PWM + Output；Right_PWM = Base_PWM - Output。这样就能实现平滑的转向。

  实操心得：PID调参是个“玄学”但有序的过程。我通常的步骤是：先P，再D，最后I。

  1. 调Kp：将Ki和Kd设为0。逐渐增大Kp，直到小车开始出现明显的围绕黑线振荡。此时的Kp约为临界值的60%-70%。
  2. 调Kd：加入Kd，从小值开始增加，能有效抑制振荡，让小车更快稳定。Kd太大反而会引入高频抖动。
  3. 调Ki：如果小车在直道上长期有固定偏向，加入一个很小的Ki来消除这个稳态误差。Ki一定要非常小，否则容易积分饱和，导致控制失控。
  4. 参数没有“黄金值”，与小车机械结构、速度、传感器安装高度都有关。必须在实际赛道上反复测试、微调。

3.2 颜色识别与任务调度

颜色识别是完成送药任务的关键。以TCS3200为例，软件流程如下：

1. 初始化：配置传感器输出频率缩放和滤光器模式。
2. 白平衡校准：在标准白色光源下，读取并保存RGB三色的基准频率值。这是保证识别准确度的前提，不同环境光下必须重校准。
3. 颜色测量：切换到相应滤光器，利用单片机的定时器输入捕获功能或简单的外部中断计数法，测量一定时间内的脉冲数，得到RGB分量频率。
4. 归一化与识别：将测量值除以白平衡时的基准值，得到归一化的RGB分量。与预先存储的“颜色特征库”进行比对（例如计算欧氏距离或设定阈值范围），找出最匹配的颜色。

任务调度是整个小车行为的“大脑”。强烈建议使用有限状态机（FSM）模型来设计。

• 定义状态：如STATE_IDLE（待机），STATE_FOLLOW_LINE（循迹），STATE_DETECT_ROOM（识别病房），STATE_DELIVER（递送药品），STATE_TURN_AROUND（转弯/掉头），STATE_ERROR（错误处理）。
• 状态转移：每个状态下，程序执行特定的操作（如持续循迹），并检测转移条件（如传感器看到十字路口、颜色传感器读到特定值）。条件满足时，切换到下一个状态。
• 优点：逻辑清晰，易于调试和维护。你可以通过一个全局状态变量和switch-case语句轻松实现。

// 状态机示例代码片段 typedef enum { IDLE, FOLLOW_LINE, DETECT_ROOM, STOP_AND_DELIVER, U_TURN, BACK_TO_START } CarState; CarState currentState = IDLE; void main() { while(1) { switch(currentState) { case IDLE: if(startButtonPressed) { currentState = FOLLOW_LINE; setMotorSpeed(BASE_SPEED, BASE_SPEED); } break; case FOLLOW_LINE: lineFollowingPID(); // 执行PID循迹 if(detectCrossroad()) { // 检测到十字路口（病房节点） stopMotor(); currentState = DETECT_ROOM; } break; case DETECT_ROOM: roomColor = readColorSensor(); if(roomColor == TARGET_ROOM_COLOR) { currentState = STOP_AND_DELIVER; } else { // 不是目标病房，继续前进一小段，回到循迹状态 delayMs(500); currentState = FOLLOW_LINE; } break; case STOP_AND_DELIVER: beep(); // 鸣笛提示 // 执行递送动作（如舵机转动） doDeliveryAction(); currentState = U_TURN; // 假设需要掉头返回 break; // ... 其他状态处理 } } }

3.3 运动控制基础：直线与转弯

除了循迹，小车还需要完成一些特定动作，如直角转弯、原地旋转（掉头）。

• 直角转弯：当传感器检测到十字路口（中间传感器和两侧传感器同时检测到黑线）时，小车需要做出90度转弯的决策。一种可靠的方法是：
  1. 小车停止在十字路口中心。
  2. 根据任务要求（左转/右转），给一侧电机正转、另一侧电机反转（或停止），形成一个旋转力矩。
  3. 旋转过程中，持续检测侧向的传感器（例如左转时看右侧传感器），当它检测到新的引导线时，停止旋转，转入正常的循迹状态。关键点：旋转的速度和时间需要根据小车轴距和轮径精确调试，或者利用传感器进行反馈控制。
• 原地旋转（掉头）：让左右电机以相同速度、相反方向转动。同样需要编码器或传感器来精确控制旋转180度。如果没有编码器，可以用定时器开环控制，但需要多次实验确定一个稳定的时间参数。

4. 硬件电路设计与关键模块调试

理论懂了，动手做的时候坑最多。这里分享几个硬件设计和调试中的核心要点。

4.1 单片机最小系统与IO分配

一个能工作的51单片机最小系统需要：单片机芯片、电源、复位电路、晶振电路。原理图虽然简单，但布局布线有讲究。

• 晶振：尽量靠近单片机引脚，走线短而粗。在晶振两端到地接一个20pF左右的电容，有助于起振稳定。
• 复位电路：上电复位和手动复位。电容和电阻的值决定了复位脉冲的宽度，典型值10uF电容配10K电阻。
• 电源滤波：在单片机的VCC和GND引脚附近，一定要放置一个0.1uF的瓷片电容进行高频去耦，这是稳定单片机运行、防止程序跑飞的关键。

IO口分配规划表：

4.2 电机驱动电路与PWM生成

以TB6612FNG为例，与单片机连接非常简单：

• VM、VCC：接电机电源（电池）和逻辑电源（5V）。
• GND：共地。
• AIN1/AIN2、BIN1/BIN2：接单片机IO，控制电机正反转和停止。
• PWMA、PWMB：接单片机PWM输出引脚，控制电机速度。
• STBY：接高电平使能。

51单片机模拟PWM：由于标准51没有硬件PWM，我们需要用定时器中断来模拟。通常使用定时器0工作在模式1（16位定时），设置一个较短的定时周期（如100us）。定义一个全局变量作为PWM周期计数器，再为每个电机定义一个“高电平时间”变量。在定时器中断里，计数器累加，并与“高电平时间”比较，从而控制对应IO口输出高低电平。改变“高电平时间”就改变了占空比。

// 定时器0初始化，用于产生PWM基准时钟 void Timer0_Init() { TMOD &= 0xF0; // 清除T0位 TMOD |= 0x01; // 设置T0为模式1，16位定时 TH0 = (65536 - 100) / 256; // 定时100us，假设晶振11.0592MHz TL0 = (65536 - 100) % 256; ET0 = 1; // 开启T0中断 TR0 = 1; // 启动T0 } unsigned int pwm_tick = 0; // PWM周期计数器 unsigned char left_high_time = 50; // 左电机高电平时间（0-100） unsigned char right_high_time = 50; // 右电机高电平时间 void Timer0_ISR() interrupt 1 { TH0 = (65536 - 100) / 256; // 重装初值 TL0 = (65536 - 100) % 256; pwm_tick++; if(pwm_tick >= 100) pwm_tick = 0; // PWM周期为100个tick，即10ms // 控制左电机PWM引脚 if(pwm_tick < left_high_time) { LEFT_PWM_PIN = 1; } else { LEFT_PWM_PIN = 0; } // 控制右电机PWM引脚 if(pwm_tick < right_high_time) { RIGHT_PWM_PIN = 1; } else { RIGHT_PWM_PIN = 0; } }

4.3 传感器安装与阈值调整

硬件的安装位置直接影响软件算法的效果。

• 循迹传感器安装：
  • 高度：距离地面约1-2厘米为宜，需要通过实验调整。太高信号弱，太低容易刮地。
  • 间距：传感器之间的间距应略小于引导线的宽度。例如，线宽2cm，传感器间距可以设为1.5cm。这样能保证在正常循迹时，最多只有1-2个传感器检测到黑线。
  • 平整度：所有传感器的探测面要在一个平面上，否则对地面的距离不一致，会导致检测阈值不同。
• 阈值调整：
  • 对于数字传感器，模块上通常有一个电位器，用于调节灵敏度。调整时，将传感器分别对准赛道白底和黑线，观察输出指示灯或单片机读到的IO状态，确保能稳定区分。
  • 对于模拟传感器，需要编写一个简单的测试程序，在赛道上读取每个传感器在白底和黑线时的AD值，然后取一个中间值作为软件判断的阈值。更高级的做法是动态阈值或使用归一化方法。

5. 软件编程框架与调试技巧

一个清晰的软件框架能极大提升开发效率和代码可维护性。

5.1 模块化编程

将不同功能封装成独立的.c和.h文件。

• motor.c/h：包含电机初始化、设置速度、设置方向、停止等函数。
• sensor.c/h：包含循迹传感器读取、颜色传感器读取与识别函数。
• pid.c/h：包含PID结构体和计算函数。
• uart.c/h：串口通信函数，用于调试时发送数据到电脑。
• main.c：主程序，包含状态机主循环和系统初始化。

在头文件(.h)中使用#ifndef ... #define ... #endif防止重复包含。全局变量尽量少用，必要时使用static关键字限制作用域。

5.2 调试：串口打印与状态指示

调试嵌入式系统，不能只靠猜。串口调试是最强大的工具。

1. 初始化串口：设置好波特率（常用9600或115200）。
2. 打印关键变量：在程序中，将传感器数值、PID输出、当前状态等通过printf函数重定向到串口发送出去。
3. 使用上位机：在电脑上用串口助手（如XCOM、SSCOM）接收数据，可以实时绘制曲线或观察数据变化，这对于调试PID参数、观察传感器响应至关重要。

例如，调试循迹时，可以每秒打印一次五路传感器的值和计算出的偏差error：

// 在调试版本中 void debugPrintSensors() { printf("Sensors: %d %d %d %d %d | Error: %d\r\n", sensor[0], sensor[1], sensor[2], sensor[3], sensor[4], line_error); }

此外，利用板载的LED来指示系统状态（如快闪表示正在寻线，常亮表示识别到目标，慢闪表示错误）也是一种直观的调试方法。

5.3 抗干扰与稳定性处理

在实际运行中，小车会遇到各种干扰。

• 传感器数据滤波：对于模拟传感器AD值或数字传感器的多次采样，可以采用中值滤波或均值滤波来消除偶然的跳变。

  // 简单均值滤波示例 #define FILTER_SIZE 5 unsigned int adc_buffer[FILTER_SIZE] = {0}; unsigned char buffer_index = 0; unsigned int getFilteredADC() { unsigned long sum = 0; adc_buffer[buffer_index] = readADC(); // 读取新值 buffer_index = (buffer_index + 1) % FILTER_SIZE; for(int i=0; i<FILTER_SIZE; i++) { sum += adc_buffer[i]; } return (unsigned int)(sum / FILTER_SIZE); }

• 软件看门狗：如果使用STC12系列，可以启用内部看门狗（WDT）。在主循环中定期喂狗。如果程序跑飞，无法按时喂狗，看门狗将复位单片机，让系统恢复。
• 异常状态处理：在状态机中，一定要有STATE_ERROR状态。当检测到异常（如长时间检测不到黑线、颜色识别连续失败多次），进入错误状态，停止电机，蜂鸣器报警，等待人工干预或尝试恢复策略（如原地旋转重新找线）。

6. 系统集成、测试与优化策略

当各个模块单独调试通过后，就到了最激动人心也最头疼的环节——系统联调。

6.1 分阶段集成测试

不要试图一次性把所有功能都加上。遵循“步步为营”的策略：

1. 第一阶段：让小车动起来。只测试电机驱动和基础PWM调速，确保小车能前进、后退、转弯。
2. 第二阶段：基础循迹。装上循迹传感器，编写最简单的左右转向逻辑（非PID），让小车能沿着简单的直线和弧度赛道行走。
3. 第三阶段：进阶循迹。引入PID算法，在复杂赛道（S弯、急弯）上调试参数，追求速度和稳定性。
4. 第四阶段：路口识别与决策。增加十字路口检测逻辑，并实现简单的直行、左转、右转决策。
5. 第五阶段：颜色识别集成。在路口处加入颜色识别流程，让小车能根据识别结果决定是否停车。
6. 第六阶段：完整任务流。将所有状态（寻线、识别、递送、返回）用状态机串联起来，完成从起点到指定病房送药并返回的全流程。

每完成一个阶段，都要进行充分测试，确保稳定后再进入下一阶段。

6.2 赛道适应性优化

比赛或评测的赛道环境可能与你调试的环境不同（光线、地面反光度）。

• 动态阈值：对于模拟传感器，可以不固定阈值。在每次上电或进入特定区域时，让小车快速扫描一下白底和黑线的值，动态计算阈值。
• 环境光补偿：对于颜色识别，如果赛场比赛时光线变化大，可以考虑在车身上增加一个遮光罩，或者使用自带光源的颜色传感器模块。
• 速度管理：小车全程全速跑并不一定最快。在直道上可以加速，在弯道前提前减速，出弯后再加速。可以建立一个“速度-曲率”映射表，根据预测的弯道急缓来动态调整基础PWM值。

6.3 常见故障排查速查表

做这个项目的过程中，我最大的体会就是“耐心”和“系统性思维”。每一个微小的成功（比如小车第一次稳稳地走完一个弯道）都建立在无数次失败的调试之上。不要害怕出现问题，每一个问题都是深入了解系统工作原理的机会。从最基础的让轮子转起来，到最终能智能地完成任务，这个过程本身就是对“电子系统综合实践”最好的诠释。最后一个小建议：在最终整合前，务必用万用表和示波器把关键节点的电压、信号波形都看一遍，很多“玄学”问题其实都是电源噪声或信号时序不对导致的。硬件是基础，软件是智慧，两者结合，才能造出真正智能的送药小车。