1. 项目概述与设计背景
在野外作战和特殊任务场景中，快速开辟安全通道是保障部队机动性的关键环节。传统人工清障方式效率低下且危险系数高，而现有警用机器人又难以适应复杂地形环境。基于这一实际需求，我们设计开发了这款基于STM32的开路清障车控制系统。
这个系统最核心的创新点在于将多种功能模块集成到一台可移动平台上：通过火焰传感器实时监测火情，利用超声波模块探测前方障碍物，配合机械臂和灭火装置实现障碍清除与火情处置。整个系统采用模块化设计思路，硬件上分为主控模块、感知模块和执行模块三大部分，软件层面则采用分层架构实现功能解耦。
选择STM32F103C8T6作为主控芯片主要基于三点考量：首先，其Cortex-M3内核提供72MHz主频，能够满足实时控制需求；其次，芯片内置丰富的外设接口（3个USART、2个SPI、2个I2C等），便于扩展各类传感器；最后，完善的开发工具链和社区支持大幅降低了开发门槛。
2. 硬件系统设计与实现
2.1 主控模块设计
2.1.1 STM32最小系统搭建
最小系统是单片机工作的基础框架，我们的设计包含以下关键电路：
- 电源电路：采用AMS1117-3.3稳压芯片，将输入电压稳定在3.3V。实际测试中，当输入电压在4.5-12V范围波动时，输出电压偏差不超过±0.05V
- 复位电路：使用10kΩ上拉电阻配合0.1μF电容构成典型RC复位电路，实测复位脉冲宽度约100ms
- 时钟电路：选用8MHz外部晶振配合22pF负载电容，通过内部PLL倍频至72MHz。在PCB布局时，晶振距离芯片保持15mm以内以降低寄生电容影响
关键提示：焊接晶振电路时，建议先使用示波器测量起振情况。我们曾遇到因电容值不匹配导致时钟不稳定的情况，最终通过更换为高质量NP0电容解决问题。
2.1.2 外设接口分配
根据功能需求，GPIO分配如下表所示：
| 外设模块 | 使用引脚 | 配置模式 |
|---|---|---|
| 超声波模块 | PA6, PA7 | TIM3_CH1, GPIO |
| 火焰传感器 | PB0 | ADC_IN8 |
| L298N驱动 | PB12, PB13, PB14 | PWM输出 |
| 灭火风扇 | PC8 | GPIO输出 |
2.2 感知模块设计
2.2.1 火焰检测方案
采用远红外火焰传感器（型号：KY-026），其核心参数包括：
- 检测波长：760nm-1100nm
- 探测角度：60°
- 响应时间：<500ms
- 工作电压：3.3-5V
在实际测试中发现，阳光直射会导致误触发。我们通过软件加入阈值判断（ADC值>800）和持续检测机制（连续3次检测到才确认），有效降低了误报率。
2.2.2 障碍物检测方案
选用HC-SR04超声波模块，其测距原理为：
- 触发引脚发送10μs高电平脉冲
- 模块自动发射8个40kHz超声波脉冲
- 计算回波高电平持续时间t（μs）
- 距离d = (t×340)/20000 （单位：米）
实测中发现，当障碍物表面为吸音材料时测距会失效。为此我们增加了最小检测距离保护（30cm）和超时处理机制。
2.3 执行机构设计
2.3.1 驱动系统
采用L298N双H桥驱动模块控制直流电机，关键设计参数：
- 电机工作电压：12V
- PWM频率：10kHz（TIM1产生）
- 死区时间：1μs（防止上下桥臂直通）
调试过程中发现模块易过热，解决方案：
- 加装散热片（尺寸40×40×10mm）
- 限制连续工作时间不超过5分钟
- 在PCB背面增加散热过孔
2.3.2 灭火系统
由12V离心风扇和舵机组成的机械臂构成。当检测到火焰时：
- 舵机旋转至火源方向（SG90，180°旋转范围）
- 风扇全速运转（电流0.8A）
- 持续3秒后复位
3. 软件系统架构
3.1 开发环境配置
使用Keil MDK 5.25开发环境，关键配置步骤：
- 安装STM32F1xx_DFP 2.3.0器件支持包
- 配置Target选项：
- IRAM1起始地址0x20000000，大小20KB
- IROM1起始地址0x08000000，大小64KB
- 优化等级选择-O2，勾选"Use MicroLIB"
3.2 主程序流程图
系统采用事件驱动架构，主循环处理流程如下：
c复制while(1){
obstacle_check(); // 障碍物检测
fire_check(); // 火焰检测
if(fire_flag){
fire_fighting(); // 灭火流程
}
if(obstacle_flag){
obstacle_clear(); // 清障流程
}
motor_control(); // 运动控制
}
3.3 关键算法实现
3.3.1 超声波测距滤波算法
原始数据存在抖动，采用滑动窗口滤波：
c复制#define SAMPLE_SIZE 5
uint32_t ultrasonic_filter(uint32_t new_val){
static uint32_t buffer[SAMPLE_SIZE] = {0};
static uint8_t index = 0;
buffer[index++] = new_val;
if(index >= SAMPLE_SIZE) index = 0;
uint32_t sum = 0;
for(uint8_t i=0; i<SAMPLE_SIZE; i++){
sum += buffer[i];
}
return sum/SAMPLE_SIZE;
}
3.3.2 电机PID控制
位置式PID实现代码：
c复制typedef struct{
float Kp, Ki, Kd;
float integral;
float prev_error;
}PID_Controller;
float pid_update(PID_Controller* pid, float setpoint, float measurement){
float error = setpoint - measurement;
pid->integral += error;
if(pid->integral > 1000) pid->integral = 1000;
if(pid->integral < -1000) pid->integral = -1000;
float derivative = error - pid->prev_error;
pid->prev_error = error;
return pid->Kp*error + pid->Ki*pid->integral + pid->Kd*derivative;
}
4. 系统调试与优化
4.1 硬件调试问题汇总
| 问题现象 | 排查方法 | 解决方案 |
|---|---|---|
| L298N模块频繁过热 | 红外热成像仪检测热点分布 | 增加散热片+限制持续工作时间 |
| 超声波测距数据跳变 | 示波器观察ECHO信号波形 | 加入软件滤波算法 |
| 火焰传感器误触发 | 改变检测阈值+环境光照测试 | 采用动态阈值调整策略 |
| 电机启动时电源电压跌落 | 电流探头测量启动电流 | 加入软启动电路 |
4.2 软件调试技巧
- 实时日志输出：通过SWD接口实现printf重定向，示例代码：
c复制// 在Target选项中勾选"Use MicroLIB"
int fputc(int ch, FILE *f){
ITM_SendChar(ch);
return ch;
}
- 内存使用监控：定期检查堆栈使用情况：
c复制extern uint32_t _estack, _Min_Stack_Size;
void check_stack_usage(){
uint32_t used = (uint32_t)&_estack - __get_MSP();
printf("Stack used: %lu/%lu bytes\n", used, (uint32_t)&_Min_Stack_Size);
}
- 性能分析：使用DWT周期计数器测量函数执行时间：
c复制#define DWT_CYCCNT ((volatile uint32_t *)0xE0001004)
void profile_function(void (*func)(void)){
CoreDebug->DEMCR |= CoreDebug_DEMCR_TRCENA_Msk;
DWT->CYCCNT = 0;
DWT->CTRL |= DWT_CTRL_CYCCNTENA_Msk;
func();
uint32_t cycles = DWT->CYCCNT;
printf("Function executed in %lu cycles\n", cycles);
}
5. 实际测试数据
5.1 灭火性能测试
| 火焰大小(cm) | 灭火时间(s) | 风扇距离(cm) |
|---|---|---|
| 10×10 | 2.8 | 30 |
| 15×15 | 4.2 | 30 |
| 20×20 | 6.1 | 30 |
| 10×10 | 5.3 | 50 |
5.2 障碍清除测试
| 障碍物材质 | 清除成功率 | 平均耗时(s) |
|---|---|---|
| 木板(5mm) | 100% | 3.2 |
| 纸箱 | 100% | 2.1 |
| 金属板(1mm) | 70% | 5.8 |
| 石块 | 40% | 8.5 |
6. 项目优化方向
经过实际测试，发现系统在以下方面还有改进空间：
- 能源管理系统：当前采用铅酸电池供电，续航约2小时。可改用锂电池组并加入电量监测功能，预计可提升续航至4小时。具体实现可参考：
c复制float read_battery_voltage(){
ADC1->CR2 |= ADC_CR2_SWSTART;
while(!(ADC1->SR & ADC_SR_EOC));
uint16_t adc_val = ADC1->DR;
return (adc_val * 3.3 / 4095) * (R1 + R2) / R2; // 电阻分压计算
}
- 多传感器融合：现有超声波传感器在复杂地形中易失效，可增加红外TOF传感器作为补充。两种传感器数据融合算法框架：
c复制typedef enum{
SENSOR_US,
SENSOR_TOF
}SensorType;
typedef struct{
SensorType type;
float distance;
uint32_t timestamp;
}SensorData;
float sensor_fusion(SensorData data[], uint8_t count){
float weighted_sum = 0;
float total_weight = 0;
for(uint8_t i=0; i<count; i++){
float weight = (data[i].type == SENSOR_US) ? 0.7 : 0.9;
weighted_sum += data[i].distance * weight;
total_weight += weight;
}
return weighted_sum / total_weight;
}
- 通信系统升级：当前使用蓝牙模块（HC-05）进行控制，传输距离有限。可改用LoRa模块（如SX1278），实现公里级远程控制。硬件修改要点：
- 将UART波特率设置为115200bps
- 增加PA和LNA前端电路
- 使用PCB天线设计时需保持净空区
在机械结构方面，测试发现现有清障装置对坚硬障碍物效果不佳。下一步计划改用液压冲击装置，通过STM32的PWM控制电磁阀开闭频率，实现冲击力度可调。初步测试表明，冲击频率在5-10Hz时清除效果最佳。