ESP32+HC-SR04超声波测距：5分钟搞定智能避障小车核心功能（附完整代码）
ESP32+HC-SR04超声波测距：5分钟搞定智能避障小车核心功能（附完整代码）
在创客教育和机器人开发领域，快速实现原型功能是激发学习兴趣的关键。ESP32作为一款功能强大的物联网开发板，搭配HC-SR04超声波模块，能轻松构建智能避障系统的核心感知单元。本文将带你从零开始，用最简单的硬件组合实现可立即应用于智能小车的避障功能。
1. 硬件准备与接线方案
1.1 所需材料清单
- 主控模块：ESP32开发板（任何型号均可）
- 测距传感器：HC-SR04超声波模块
- 执行机构：L298N电机驱动模块 + 直流电机×2
- 辅助元件：LED指示灯、220Ω电阻
- 电源系统：18650锂电池×2（带电池盒）
- 连接线材：杜邦线若干
提示：若使用ESP32-CAM等特殊型号，需注意GPIO引脚分配差异
1.2 优化接线方案
传统教程常建议使用分压电阻处理Echo信号，但ESP32的GPIO多数支持5V容忍输入。推荐以下直连方案：
| 模块引脚 | ESP32连接引脚 | 备注 |
|---|---|---|
| HC-SR04 VCC | 5V或3.3V | 实测3.3V供电仍可工作 |
| HC-SR04 GND | GND | 共地连接 |
| HC-SR04 Trig | GPIO23 | 任意输出引脚 |
| HC-SR04 Echo | GPIO22 | 支持5V输入的引脚 |
| L298N IN1 | GPIO12 | 电机A方向控制 |
| L298N IN2 | GPIO13 | 电机A速度控制 |
| L298N IN3 | GPIO14 | 电机B方向控制 |
| L298N IN4 | GPIO15 | 电机B速度控制 |
| LED阳极 | GPIO2 | 经220Ω限流电阻 |
// 引脚定义预检查 #if CONFIG_IDF_TARGET_ESP32S2 || CONFIG_IDF_TARGET_ESP32C3 #error "部分GPIO在ESP32-S2/C3上不可用，需调整引脚定义" #endif2. 核心代码实现与优化
2.1 基础测距功能封装
以下代码对原始测距逻辑进行了三项重要改进：
- 自动校准环境基准值
- 加入信号超时处理
- 硬件异常检测
class Ultrasonic { private: uint8_t trigPin, echoPin; float baseline = 0; public: Ultrasonic(uint8_t trig, uint8_t echo) : trigPin(trig), echoPin(echo) {} void begin() { pinMode(trigPin, OUTPUT); pinMode(echoPin, INPUT); digitalWrite(trigPin, LOW); calibrate(); } void calibrate(int samples=10) { float sum = 0; for(int i=0; i<samples; i++) { sum += rawDistance(); delay(50); } baseline = sum / samples; } float distance() { float d = rawDistance() - baseline; return constrain(d, 2, 400); // 有效范围限定 } private: float rawDistance() { digitalWrite(trigPin, HIGH); delayMicroseconds(12); // 优化后的脉冲宽度 digitalWrite(trigPin, LOW); unsigned long timeout = micros() + 30000UL; // 30ms超时 while(digitalRead(echoPin) == LOW && micros() < timeout); if(micros() >= timeout) return NAN; unsigned long start = micros(); while(digitalRead(echoPin) == HIGH && micros() < timeout); unsigned long duration = micros() - start; return duration * 0.017; // 0.034/2 优化计算 } };2.2 电机控制逻辑
针对智能小车场景，我们实现差速转向控制：
void motorControl(float distance) { const float safeDist = 30.0; // 安全距离(cm) const float maxSpeed = 200; // PWM最大值 if(distance > safeDist || isnan(distance)) { // 前进 analogWrite(MOTOR_A_PWM, maxSpeed); analogWrite(MOTOR_B_PWM, maxSpeed); digitalWrite(MOTOR_A_DIR, HIGH); digitalWrite(MOTOR_B_DIR, HIGH); } else { // 根据距离动态调整转向角度 float ratio = distance / safeDist; analogWrite(MOTOR_A_PWM, maxSpeed * ratio); analogWrite(MOTOR_B_PWM, maxSpeed * (1.2 - ratio)); // 随机选择转向方向更符合真实场景 static bool turnRight = true; turnRight = !turnRight; digitalWrite(MOTOR_A_DIR, turnRight); digitalWrite(MOTOR_B_DIR, !turnRight); } }3. 系统集成与调试技巧
3.1 阈值动态调整方案
传统固定阈值法在复杂环境中表现不佳，建议采用自适应算法：
环境学习阶段（上电后前5秒）：
- 记录无障碍物时的基准距离
- 统计环境噪声水平
动态阈值计算：
# 伪代码示意 safe_threshold = baseline + 3*std_dev + 15cm warning_threshold = baseline + 2*std_dev + 10cm实时校准机制：
- 每30秒检测一次环境基准值
- 当连续10次测量异常时触发重新校准
3.2 常见问题排查表
| 现象 | 可能原因 | 解决方案 |
|---|---|---|
| 测量值固定为0 | Trig/Echo接线反接 | 交换两根信号线 |
| 数值波动大 | 电源干扰 | 增加100μF电容并联 |
| 测量范围缩小 | 传感器表面污损 | 清洁传感器表面 |
| 电机响应延迟 | PWM频率不匹配 | 设置电机驱动频率为1kHz |
| 偶尔误触发 | 环境回声干扰 | 在代码中添加中值滤波 |
4. 进阶功能扩展
4.1 多传感器阵列配置
对于更复杂的避障需求，可扩展为三传感器方案：
Ultrasonic sensors[3] = { Ultrasonic(23, 22), // 前向 Ultrasonic(18, 19), // 左侧 Ultrasonic(5, 17) // 右侧 }; void setup() { for(auto &sensor : sensors) { sensor.begin(); } } void loop() { float distances[3]; for(int i=0; i<3; i++) { distances[i] = sensors[i].distance(); } // 决策逻辑 if(distances[0] < 20) { if(distances[1] > distances[2]) { turnLeft(); } else { turnRight(); } } }4.2 状态可视化增强
通过WS2812 LED灯带实现距离可视化反馈：
#include <Adafruit_NeoPixel.h> Adafruit_NeoPixel pixels(8, GPIO_NUM_21, NEO_GRB + NEO_KHZ800); void updateLEDs(float distance) { int lit = map(constrain(distance, 0, 100), 0, 100, 8, 0); for(int i=0; i<8; i++) { if(i < lit) { int r = map(i, 0, 7, 0, 255); int g = map(i, 0, 7, 255, 0); pixels.setPixelColor(i, pixels.Color(r, g, 0)); } else { pixels.setPixelColor(i, 0); } } pixels.show(); }5. 完整项目代码框架
以下为可直接用于智能小车的完整工程结构：
/smart-car-esp32 │── /lib │ └── Ultrasonic # 封装好的超声波库 ├── /platformio.ini # 项目配置 └── /src ├── main.cpp # 主逻辑 └── motor.h # 电机驱动封装关键代码片段：
// main.cpp #include "motor.h" #include <Ultrasonic.h> Ultrasonic frontSensor(23, 22); MotorDriver motors; void setup() { Serial.begin(115200); frontSensor.begin(); motors.attach(12,13,14,15); motors.setSpeed(0); // 初始停止 } void loop() { float dist = frontSensor.getFilteredDistance(); if(dist < 10) { motors.emergencyStop(); tone(BUZZER_PIN, 2000, 300); } else if(dist < 30) { motors.setSpeed(map(dist, 10,30, 30,100)); } else { motors.setSpeed(100); } delay(50); }实际部署时发现，为电机驱动添加软启动逻辑可有效降低电流冲击：
void MotorDriver::setSpeed(uint8_t target) { const uint8_t step = 5; while(currentSpeed != target) { currentSpeed += (target > currentSpeed) ? step : -step; analogWrite(pwmPinA, currentSpeed); analogWrite(pwmPinB, currentSpeed); delay(20); } }