避障小车三个超声波传感器避障代码

在编写避障小车的三路超声波传感器避障代码时，通常会使用Arduino或类似微控制器作为控制核心。以下是一个基本的示例，它展示了如何读取三个传感器的数据并基于它们的距离做出决策：

#include <Servo.h> // 引入用于电机控制的库

const int trigPin1 = 9; // 第一个传感器的触发信号
const int echoPin1 = 10; // 第一个传感器的回声信号
const int trigPin2 = 8; // 第二个传感器的触发信号
const int echoPin2 = 7; // 第二个传感器的回声信号
const int trigPin3 = 5; // 第三个传感器的触发信号
const int echoPin3 = 4; // 第三个传感器的回声信号

Servo motor; // 创建一个伺服电机对象

void setup() {
  Serial.begin(9600); // 初始化串口通信
  motor.attach(11); // 连接电机到数字11
}

void loop() {
  int distance1, distance2, distance3;
  
  // 读取每个传感器的距离
  delayMicroseconds(10);
  distance1 = pulseIn(echoPin1, HIGH, pulseIn(trigPin1, LOW, 2000)); // 超声波传播时间计算
  distance2 = pulseIn(echoPin2, HIGH, pulseIn(trigPin2, LOW, 2000));
  distance3 = pulseIn(echoPin3, HIGH, pulseIn(trigPin3, LOW, 2000));

  // 根据阈值判断距离是否过近，接近则停止或转向
  if (distance1 < 30) { // 假设安全距离为30cm
    motor.write(0); // 小车停止
    Serial.println("障碍物1接近");
  } else {
    motor.write(100); // 正常行驶
  }

  if (distance2 < 30) {
    motor.write(-100); // 右转避开
    Serial.println("障碍物2接近");
  }
  
  if (distance3 < 30) {
    motor.write(100); // 左转避开
    Serial.println("障碍物3接近");
  }
  
  // 等待一段时间再进行下一轮检测
  delay(500);
}