不止于测距：用STM32和HC-SR04做个简易倒车雷达/智能避障小车（完整项目源码）

从超声波测距到智能避障：STM32与HC-SR04的实战系统设计

超声波测距模块HC-SR04因其低成本、易用性，成为嵌入式开发者实现距离检测的首选。但大多数教程仅停留在基础驱动层面，未能展现其在实际系统中的完整价值。本文将带你从模块驱动到系统集成，构建一个具备实时反馈的智能避障系统。

1. 项目架构设计与硬件选型

一个完整的超声波应用系统需要解决三个核心问题：精确测距、实时反馈和决策控制。我们选择STM32F103C8T6作为主控，配合HC-SR04模块、WS2812B LED灯带和有源蜂鸣器构建硬件平台。

关键硬件参数对比：

硬件连接方案：

• PA6 → Trig
• PA7 → Echo
• PB8 → LED灯带数据线
• PB9 → 蜂鸣器控制

提示：实际布线时，超声波模块应远离电机等干扰源，信号线长度不宜超过30cm。

2. 高可靠性测距实现

基础测距原理虽简单，但实际应用中需要解决以下问题：

2.1 信号抗干扰处理

原始代码中的轮询检测方式存在明显缺陷：

while(ECHO == 0); // 等待高电平 TIM_SetCounter(TIM2,0); while(ECHO == 1); // 等待低电平

改进方案是采用外部中断+定时器捕获：

// 中断配置 void EXTI_Config(void) { GPIO_InitTypeDef GPIO_InitStructure; EXTI_InitTypeDef EXTI_InitStructure; RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA | RCC_APB2Periph_AFIO, ENABLE); GPIO_InitStructure.GPIO_Pin = GPIO_Pin_7; GPIO_InitStructure.GPIO_Mode = GPIO_Mode_IPD; GPIO_Init(GPIOA, &GPIO_InitStructure); GPIO_EXTILineConfig(GPIO_PortSourceGPIOA, GPIO_PinSource7); EXTI_InitStructure.EXTI_Line = EXTI_Line7; EXTI_InitStructure.EXTI_Mode = EXTI_Mode_Interrupt; EXTI_InitStructure.EXTI_Trigger = EXTI_Trigger_Rising_Falling; EXTI_InitStructure.EXTI_LineCmd = ENABLE; EXTI_Init(&EXTI_InitStructure); }

2.2 数据滤波算法

原始数据波动较大，需采用复合滤波：

1. 中值滤波：连续采样5次，取中间值
2. 一阶滞后滤波：weight = 0.3
3. 动态阈值滤波：根据历史数据自动调整有效范围

滤波实现示例：

#define SAMPLE_SIZE 5 float median_filter(float new_sample) { static float buffer[SAMPLE_SIZE]; static uint8_t index = 0; buffer[index++] = new_sample; if(index >= SAMPLE_SIZE) index = 0; // 排序实现省略... return buffer[SAMPLE_SIZE/2]; }

3. 多模态反馈系统设计

单一的数字显示不够直观，我们设计三级反馈机制：

3.1 视觉反馈（LED灯带）

• 绿色(0-50cm)：安全距离
• 黄色(50-100cm)：注意距离
• 红色(>100cm)：危险距离

WS2812B驱动关键代码：

void set_led_color(uint32_t color) { for(int i=0; i<LED_NUM; i++) { send_byte((color >> 16) & 0xFF); // R send_byte((color >> 8) & 0xFF); // G send_byte(color & 0xFF); // B } RESET_PULSE(); }

3.2 听觉反馈（蜂鸣器）

采用PWM调制实现变频报警：

void beep_alert(float distance) { if(distance < 30) { TIM_SetAutoreload(TIM3, 1000); // 高频 TIM_SetCompare1(TIM3, 500); } else if(distance < 100) { TIM_SetAutoreload(TIM3, 2000); // 中频 TIM_SetCompare1(TIM3, 1000); } }

3.3 触觉反馈（可选）

可通过电机振动实现：

• 振动强度与距离成反比
• 振动模式可编码不同警告级别

4. 系统集成与优化

4.1 多传感器融合

单个超声波模块存在检测盲区，建议配置三个模块：

• 前向主检测（水平安装）
• 左右各一个（45度斜装）

传感器布局方案：

[左传感器] \ [主传感器] / [右传感器]

数据融合算法：

float get_safe_distance(void) { float dist[3]; dist[0] = get_front_distance(); dist[1] = get_left_distance() * 0.707; // 余弦补偿 dist[2] = get_right_distance() * 0.707; return min_3(dist[0], dist[1], dist[2]); }

4.2 电源管理优化

系统总电流需求：

• STM32：约50mA
• 3×HC-SR04：峰值300mA
• LED灯带：每颗约20mA

推荐采用TPS5430 DC-DC降压模块，效率可达90%以上。

4.3 机械结构设计

考虑以下因素：

• 传感器安装高度：距地面40-60cm
• 防护结构：避免碰撞损坏
• 散热设计：特别是电机驱动部分

5. 进阶功能实现

5.1 路径记忆与学习

通过记录历史数据，建立环境模型：

typedef struct { float distance; uint32_t timestamp; uint8_t direction; } env_record_t; #define HISTORY_SIZE 50 env_record_t env_history[HISTORY_SIZE];

5.2 无线监控接口

添加蓝牙模块实现手机监控：

• 实时距离数据显示
• 报警阈值设置
• 历史数据图表

HC-05配置示例：

AT+NAME=UltrasonicRadar AT+PSWD=1234 AT+UART=115200,0,0

5.3 能耗优化策略

1. 动态采样频率：根据移动速度调整
2. 模块休眠控制：非活跃期关闭传感器
3. 自适应亮度：根据环境光调节LED

实现代码框架：

void power_save_mode(void) { if(no_movement_detected()) { set_sampling_rate(1); // 1Hz led_brightness(30); } else { set_sampling_rate(10); // 10Hz led_brightness(100); } }

在完成基础功能后，尝试为系统添加一个简单的状态机管理，可以使代码更加结构化。例如定义几种工作模式：初始化模式、正常运行模式、低功耗模式和紧急停止模式。通过按键或距离触发模式切换，每个模式对应不同的传感器采样策略和反馈强度。