别再只会测距了！用Arduino+HC-SR04超声波模块做个智能防撞小车（附完整代码）

从测距到避障：用Arduino和HC-SR04打造智能防撞小车的完整指南

超声波测距模块在创客项目中一直扮演着重要角色，但大多数教程止步于基础的距离测量。今天，我们要将这个看似简单的传感器玩出新高度——打造一台能够自主避障的智能小车。这不仅是技术能力的提升，更是思维方式的转变：从被动测量到主动决策。

1. 项目核心组件与原理

智能防撞小车的核心在于将传感器数据转化为运动决策。我们需要理解每个组件的特性以及它们如何协同工作。

HC-SR04超声波模块是这个项目的基础传感器，它通过发射40kHz的超声波并计算回波时间来确定前方障碍物的距离。与红外传感器相比，超声波不受光线影响，在复杂环境中表现更稳定。但要注意它的探测角度约15度，这意味着我们需要合理安装位置以获得最佳检测范围。

关键组件对比表：

提示：L298N模块虽然经典，但效率较低。如果追求更高性能，可以考虑TB6612等更现代的驱动芯片，它们体积更小、发热更低。

超声波测距的基本公式很简单：

距离(cm) = (高电平时间×声速340m/s) ÷ 2

但在实际应用中，我们需要考虑温度对声速的影响。更精确的公式应该是：

float distance = (duration * 0.0343 * (1 + 0.0006 * (temperature - 20))) / 2;

其中temperature是环境摄氏温度。对于一般室内应用，可以忽略温度补偿，但在温差大的环境中，这会显著提高测量精度。

2. 硬件搭建与电路连接

正确的硬件连接是项目成功的基础。不同于简单的测距实验，智能小车需要考虑电源管理、信号稳定性和机械结构等多方面因素。

首先规划电源系统。常见错误是试图用Arduino的5V输出同时为HC-SR04和电机供电，这会导致电压不稳甚至Arduino重启。正确的做法是：

1. 使用独立18650电池组（7.4V）作为主电源
2. 通过L298N的5V输出为Arduino供电（跳过USB接口）
3. HC-SR04直接连接到Arduino的5V引脚

电路连接步骤：

1. 将L298N的+12V接电池正极，GND接电池负极
2. 连接L298N的5V输出到Arduino Vin引脚
3. HC-SR04的VCC接Arduino 5V，GND接Arduino GND
4. Trig接数字引脚9，Echo接数字引脚10
5. 电机输出A接左轮，输出B接右轮
6. 确保所有GND最终都连接到一起

传感器安装角度直接影响避障效果。理想情况下，传感器应朝前水平安装，高度约15-20cm（相当于常见障碍物如墙壁、家具的高度）。如果使用单个传感器，可以考虑添加简易舵机实现左右扫描，但这会增加程序复杂度。

// 基础引脚定义 const int trigPin = 9; const int echoPin = 10; const int motorLeft1 = 5; // L298N IN1 const int motorLeft2 = 6; // L298N IN2 const int motorRight1 = 7; // L298N IN3 const int motorRight2 = 8; // L298N IN4

注意：电机工作时会产生电噪声，可能导致超声波测量异常。解决方法包括：在电源端加装大容量电容（如1000μF），测量时短暂停止电机，或使用软件滤波算法。

3. 避障算法设计与实现

有了稳定的硬件基础，接下来是赋予小车"智能"的关键——避障算法。这里我们将实现三种基本策略：急停、转向避障和后退转向组合。

最简单的策略是阈值触发：当检测到障碍物距离小于安全值（如20cm）时立即停止。但这种反应过于机械，体验不佳。更智能的方法是分级响应：

• 30-50cm：减速
• 20-30cm：准备转向
• <20cm：立即转向

避障状态机实现：

void loop() { float distance = getDistance(); if(distance > 50) { moveForward(); // 无障碍，正常前进 } else if(distance > 30) { moveSlow(); // 检测到远处障碍，减速 } else if(distance > 20) { prepareTurn(); // 准备转向 } else { avoidObstacle(); // 执行避障动作 } } void avoidObstacle() { stopMotors(); delay(100); // 随机选择左转或右转，避免陷入死循环 if(random(0, 2) == 0) { turnLeft(); } else { turnRight(); } delay(500); // 转向持续时间 }

对于更复杂的场景，可以考虑记忆最近几次的转向方向，避免在小空间内来回震荡。下面是一个改进版的避障逻辑：

int lastTurn = 0; // 0=左, 1=右 void smartAvoid() { stopMotors(); delay(100); // 如果上次左转，这次优先右转 if(lastTurn == 0) { if(checkRightSpace() > 30) { turnRight(); lastTurn = 1; } else { turnLeft(); } } else { if(checkLeftSpace() > 30) { turnLeft(); lastTurn = 0; } else { turnRight(); } } delay(500); }

提示：在实际测试中，你会发现简单的距离阈值可能不够。结合历史数据和当前趋势（如距离是在快速减小还是缓慢变化）可以做出更合理的决策。

4. 代码优化与调试技巧

完成基础功能后，我们需要优化代码结构并解决实际调试中遇到的问题。好的代码不仅功能完善，还应易于理解和修改。

首先封装超声波测距功能，加入简单的滤波处理：

float getFilteredDistance() { const int samples = 5; float sum = 0; for(int i=0; i<samples; i++) { sum += getRawDistance(); delay(30); // 适当间隔避免声波干扰 } return sum / samples; } float getRawDistance() { digitalWrite(trigPin, LOW); delayMicroseconds(2); digitalWrite(trigPin, HIGH); delayMicroseconds(10); digitalWrite(trigPin, LOW); long duration = pulseIn(echoPin, HIGH, 30000); // 超时约5米 return duration * 0.034 / 2; }

电机控制也应该封装成独立函数，方便调整参数：

void setMotorSpeed(int leftSpeed, int rightSpeed) { // 限制速度范围 leftSpeed = constrain(leftSpeed, -255, 255); rightSpeed = constrain(rightSpeed, -255, 255); // 左电机控制 if(leftSpeed > 0) { analogWrite(motorLeft1, leftSpeed); digitalWrite(motorLeft2, LOW); } else { digitalWrite(motorLeft1, LOW); analogWrite(motorLeft2, -leftSpeed); } // 右电机控制同理 if(rightSpeed > 0) { analogWrite(motorRight1, rightSpeed); digitalWrite(motorRight2, LOW); } else { digitalWrite(motorRight1, LOW); analogWrite(motorRight2, -rightSpeed); } }

调试时常见问题及解决方法：

1. 测量值不稳定：

   • 检查电源是否充足
   • 添加软件滤波（如上面实现的平均值滤波）
   • 确保传感器固定牢固，避免震动

2. 电机干扰超声波：

   • 测量时短暂停止电机
   • 在电源端并联大电容
   • 使用独立的电源为Arduino和传感器供电

3. 小车总是偏向一侧：

   • 校准电机速度（不同电机转速可能有差异）
   • 在代码中加入速度补偿系数
   • 检查轮子是否安装牢固，有无打滑

// 电机校准示例 float leftAdjust = 0.9; // 左电机补偿系数 void moveForwardAdjusted() { setMotorSpeed(200 * leftAdjust, 200); }

5. 进阶改进方向

基础避障功能实现后，可以考虑以下扩展方案，让你的小车更加智能：

多传感器融合：增加第二个HC-SR04，分别指向左右两侧，实现更全面的环境感知。安装时注意两个传感器的触发时间要错开，避免相互干扰。

// 双超声波传感器读取 float getLeftDistance() { digitalWrite(trigLeft, HIGH); delayMicroseconds(10); digitalWrite(trigLeft, LOW); return pulseIn(echoLeft, HIGH) * 0.034 / 2; } float getRightDistance() { digitalWrite(trigRight, HIGH); delayMicroseconds(10); digitalWrite(trigRight, LOW); return pulseIn(echoRight, HIGH) * 0.034 / 2; }

路径记忆与迷宫求解：通过记录转向历史，让小车学会在复杂环境中寻找出口。简单的右手法则（始终沿着右侧墙壁走）就能解决大多数迷宫问题。

无线遥控与模式切换：添加蓝牙模块，通过手机APP在手动控制和自动避障模式间切换。这需要处理多任务逻辑，可以考虑使用有限状态机设计模式。

环境映射：结合编码器或IMU传感器，记录小车的运动轨迹，逐步构建简单环境地图。虽然精度有限，但作为学习SLAM（同步定位与地图构建）的入门项目非常合适。

性能优化对比表：

提示：进阶改进建议逐个实现，不要一开始就尝试所有功能。先从增加一个侧面超声波传感器开始，逐步完善小车的感知能力。