HY-SRF05超声波模块避障小车实战：从引脚解析到代码实现-平芜编程栈

1. HY-SRF05超声波模块基础解析

第一次拿到HY-SRF05模块时，我盯着那五个金属引脚发了会儿呆——这玩意儿真能帮小车避开障碍物？后来实测发现，这个比硬币大不了多少的模块，确实能稳定检测2cm到4.5米范围内的物体。它的工作原理很像蝙蝠探路：发射40kHz的超声波，遇到障碍物反弹后，通过计算声波往返时间得出距离。

模块背面的五个引脚中，VCC和GND负责供电。虽然手册标注需要5V电压，但实测3.3V也能工作（不过测距范围会略微缩小）。OUT引脚比较特殊，多数情况下可以悬空不接，它主要用于报警功能，当检测距离小于某个阈值时会输出信号。

真正关键的是Trig和Echo两个引脚：前者像开关，给它10微秒的高电平就会触发一次测距；后者像回声探测器，会输出一个与距离成正比的高电平脉冲。记得第一次调试时，我把Trig和Echo接反了，模块死活不工作，后来用示波器抓信号才发现问题。

2. STM32硬件连接实战

给STM32接线就像玩拼图，接对了才能点亮技能树。我用的是STM32F103C8T6最小系统板，具体连接方式如下表：

HY-SRF05引脚	STM32引脚	配置模式
VCC	5V/3.3V	电源输出
GND	GND	共地
Trig	PA6	推挽输出
Echo	PA7	浮空输入

这里有个坑要注意：Echo引脚返回的是5V电平，而STM32的GPIO耐受电压是3.3V。我的解决方案是在Echo和PA7之间串接1kΩ电阻，也可以使用电平转换模块。曾经偷懒直接连接，结果烧了一个IO口，血泪教训啊！

电源部分推荐加个0.1μF的去耦电容，能有效抑制干扰。如果小车电机干扰严重，可以在模块电源端增加LC滤波电路。有次比赛现场，其他队伍的电机一启动我的测距就飘了，后来加了磁珠才解决问题。

3. 时序控制与代码实现

要让模块正常工作，必须严格遵循时序。就像指挥交响乐，每个节拍都不能错：

给Trig引脚至少10μs的高电平（我习惯用12μs）
模块自动发射8个40kHz脉冲
等待Echo引脚变高后启动定时器
Echo变低时停止计时
计算距离 = 高电平时间(μs)/58

对应的STM32标准库代码长这样：

// GPIO初始化 void Ultrasonic_Init(void) { GPIO_InitTypeDef GPIO_InitStruct; RCC_APB2PeriphClockCmd(RCC_APB2Periph_GPIOA, ENABLE); // Trig引脚配置 GPIO_InitStruct.GPIO_Pin = GPIO_Pin_6; GPIO_InitStruct.GPIO_Mode = GPIO_Mode_Out_PP; GPIO_InitStruct.GPIO_Speed = GPIO_Speed_50MHz; GPIO_Init(GPIOA, &GPIO_InitStruct); // Echo引脚配置 GPIO_InitStruct.GPIO_Pin = GPIO_Pin_7; GPIO_InitStruct.GPIO_Mode = GPIO_Mode_IN_FLOATING; GPIO_Init(GPIOA, &GPIO_InitStruct); } // 触发测距 void Trigger_Signal(void) { GPIO_SetBits(GPIOA, GPIO_Pin_6); delay_us(12); GPIO_ResetBits(GPIOA, GPIO_Pin_6); } // 获取距离(cm) float Get_Distance(void) { uint32_t timeout = 0; float distance = 0; Trigger_Signal(); while(GPIO_ReadInputDataBit(GPIOA, GPIO_Pin_7)==0){ if(timeout++ > 10000) return 999; // 超时返回无效值 } TIM_SetCounter(TIM2, 0); while(GPIO_ReadInputDataBit(GPIOA, GPIO_Pin_7)); distance = TIM_GetCounter(TIM2) * 340 / 2 / 10000.0; // 单位cm return distance; }

4. 避障算法设计与优化

拿到距离数据只是开始，如何让小车智能避障才是重头戏。我总结出三种实用策略：

分级制动方案：

当距离>50cm：全速前进
30cm<距离≤50cm：减速至70%
10cm<距离≤30cm：减速至30%并准备转向
距离≤10cm：紧急停止

转向决策树：

void Avoidance_Control(float dist) { if(dist > SAFE_DISTANCE){ Motor_Forward(100); } else { Motor_Stop(); float left_dist = Check_LeftSide(); float right_dist = Check_RightSide(); if(left_dist > right_dist && left_dist > 20){ Motor_TurnLeft(300); } else if(right_dist > 20){ Motor_TurnRight(300); } else { Motor_Backward(200); delay_ms(500); } } }

卡尔曼滤波应用：原始数据会有波动，可以加入滤波算法：

#define Q 0.022 #define R 0.617 float Kalman_Filter(float z_measure) { static float x_last = 0; static float p_last = 0; float x_mid = x_last; float p_mid = p_last + Q; float kg = p_mid / (p_mid + R); float x_now = x_mid + kg * (z_measure - x_mid); float p_now = (1 - kg) * p_mid; x_last = x_now; p_last = p_now; return x_now; }

实测发现，加入滤波后测距稳定性提升40%以上，特别是在小车震动环境下。有次演示时，没滤波的小车在瓷砖地上疯狂"抽搐"，加了滤波后立刻稳如老狗。

5. 常见问题与调试技巧

问题1：测距值固定为最大值

检查Trig信号是否正常（用示波器看10μs脉冲）
确认Echo引脚接线正确
测量模块供电电压是否达标

问题2：数据偶尔跳变

在Trig和Echo线上加10kΩ上拉电阻
确保测量周期>60ms（防止声波干扰）
避开其他超声波设备的工作频段

问题3：近距离检测失效

调整模块安装角度（建议俯角15°）
在代码中设置死区（<2cm时忽略）
检查是否有机械振动干扰

有个特别隐蔽的坑：当电源纹波过大时，模块会间歇性失灵。后来我在电源端并联了220μF电解电容+0.1μF陶瓷电容，问题迎刃而解。

6. 进阶应用拓展

基础避障玩腻了？试试这些升级玩法：

多模块阵列：

// 安装三个模块：左中右 float dist[3]; void Multi_Sensor_Scan(void) { for(int i=0; i<3; i++){ Select_Module(i); // 74HC138选通 dist[i] = Get_Distance(); } }

通过CD4051等模拟开关可以扩展多个模块，实现环境地图构建。

与红外传感器融合：

if(Ultrasonic_Get() < 30 || Infrared_Get() < 15){ Emergency_Stop(); }

超声波对透明物体检测效果差，配合红外可以互补。

云台联动方案：

void Scan_Mode(void) { for(int angle=0; angle<180; angle+=10){ Servo_Set(angle); delay_ms(100); float dist = Get_Distance(); Map_Update(angle, dist); } }

用SG90舵机带动模块旋转，实现180°环境扫描。

最后分享一个性能对比数据（测试环境：室温25℃，障碍物为木板）：