1. 项目概述
驿站取货小车系统是一种基于STM32微控制器的智能搬运装置，专为解决快递驿站最后一米配送难题而设计。这个项目源于我在某高校物流实验室参与的真实课题，当时我们观察到校园快递站高峰期经常出现排队拥堵现象，特别是大件包裹搬运效率低下。于是萌生了开发一款能够自主导航、自动取货的智能小车的想法。
整套系统由STM32F103C8T6最小系统板作为主控，配合超声波传感器、红外对管、电机驱动模块等外围器件构成。小车通过预设路径算法在驿站货架间移动，利用机械臂完成包裹抓取，最终将货物运送至指定取件区。相比传统人工分拣方式，这套系统可将单件包裹处理时间缩短40%以上，特别适合日均500-1000件的中小型驿站使用。
2. 硬件系统设计
2.1 主控芯片选型
我们选择STM32F103C8T6作为核心控制器，主要基于三点考量：
- 72MHz主频的Cortex-M3内核足够处理多传感器数据融合
- 内置的定时器资源完美匹配PWM电机控制需求
- 丰富的外设接口（5个USART、2个SPI、2个I2C）便于扩展
实际采购时要注意区分正版ST芯片与国产兼容型号。我们曾遇到GD32仿制芯片无法正常烧录的情况，最终通过检查芯片丝印"ST"标识解决了问题。
2.2 运动控制系统
采用双路L298N电机驱动模块控制两个直流减速电机（12V/30RPM），关键参数配置如下：
| 参数 | 配置值 | 计算依据 |
|---|---|---|
| PWM频率 | 10kHz | 高于电机电感截止频率 |
| 死区时间 | 1μs | 防止H桥上下管直通 |
| 加速度曲线 | S型曲线 | 减少机械冲击 |
电机编码器通过TIM2/TIM3的编码器接口模式采集，每转产生390个脉冲，配合32位累加器实现精确里程计算。
2.3 环境感知模块
多传感器融合方案确保导航可靠性：
- HC-SR04超声波模块（3组前向布置）
- TCRT5000红外对管（地面黑线检测）
- MPU6050六轴传感器（防倾覆监测）
传感器布局采用金字塔结构：最下层红外管距地1cm检测路径标记，中层超声波安装在30cm高度探测障碍物，顶部IMU监测车身姿态。这种布置方式在实测中实现了98.7%的障碍物识别率。
3. 软件架构实现
3.1 实时操作系统选择
移植FreeRTOS实现多任务调度，任务优先级设置如下：
c复制#define TASK_PRIORITY_MOTOR (tskIDLE_PRIORITY + 4)
#define TASK_PRIORITY_SENSOR (tskIDLE_PRIORITY + 3)
#define TASK_PRIORITY_COMM (tskIDLE_PRIORITY + 2)
#define TASK_PRIORITY_UI (tskIDLE_PRIORITY + 1)
关键技巧：电机控制任务必须设为最高优先级，否则会出现控制延迟导致轨迹偏移。我们曾因优先级设置不当导致小车在转弯时出现5cm的位置偏差。
3.2 导航算法实现
路径规划采用改进的栅格法：
- 将驿站平面图离散化为20cm×20cm栅格
- 使用A*算法计算最优路径
- 动态避障通过DWA算法实时调整
python复制# 伪代码示例
def dynamic_window_approach():
v_range = [0, max_speed]
w_range = [-max_turn, max_turn]
for v in v_range:
for w in w_range:
trajectory = simulate_motion(v,w)
if collision_free(trajectory):
score = evaluate(trajectory)
return best_(v,w)
实测表明，该算法在3m×4m的测试场地内可实现±2cm的定位精度。
3.3 机械臂控制逻辑
四自由度机械臂采用逆运动学求解：
- 通过QR码识别获取包裹位置坐标(x,y,z)
- 使用几何法计算各关节角度θ₁-θ₄
- 加入加速度规划防止抖动
关节角度计算公式：
θ₂ = arccos[(x²+y²-L₁²-L₂²)/(2L₁L₂)]
θ₁ = atan2(y,x) - atan2(L₂sinθ₂, L₁+L₂cosθ₂)
调试时发现金属齿轮存在回程差，后来在代码中加入0.5°的补偿值解决了定位偏差问题。
4. 系统集成与测试
4.1 电源管理设计
采用分级供电方案：
- 主控电路：AMS1117-3.3稳压
- 传感器：LM2596降压至5V
- 电机驱动：直接12V锂电池供电
关键经验：电机启停会在电源线上产生高达2V的尖峰电压，我们通过在STM32的VDD引脚添加100μF钽电容+0.1μF陶瓷电容组合，有效抑制了复位现象。
4.2 通信协议设计
上位机通信采用自定义轻量协议：
code复制[HEAD][LEN][CMD][DATA][CRC]
0xAA 1 1 N 1
测试数据表明，在115200bps波特率下，该协议可实现30ms的指令响应周期，完全满足实时控制需求。
4.3 典型问题排查
- 电机异响问题
现象：低速运行时出现"咔嗒"声
排查：
- 检查PWM频率→正常
- 测量电流波形→发现断续
解决：在电机两端并联100nF电容消除反电动势干扰
- 路径跟踪漂移
现象：直线行驶时逐渐偏离
排查：
- 编码器计数→正常
- 轮胎直径测量→右轮磨损0.5mm
解决：在控制算法中加入轮胎补偿系数
5. 实际应用优化
在三个月试运行期间，我们针对驿站真实场景做了多项改进：
- 货架适配方案
- 增加激光测距模块识别货架间距
- 开发自动间距调整算法
实测数据显示，改进后对不同规格货架的适应率从72%提升至95%
- 多包裹批量处理
- 优化机械臂运动轨迹
- 实现连续取件路径规划
使得单次充电后的有效工作时间延长了40分钟
- 异常处理机制
- 添加低电量自动回充
- 设计防跌落边界检测
系统无故障运行时间从8小时提升至72小时
这套系统最终在某高校驿站部署后，高峰期客户平均等待时间由15分钟降至6分钟，工作人员劳动强度降低约60%。特别是在处理5kg以上大件包裹时，优势更为明显。