超声波控制双舵机代码

超声波控制双舵机的代码通常用于机器人或者自动化项目中，它结合了超声波传感器的距离检测功能和舵机的运动控制。下面是一个简单的Arduino示例，假设你有 Ultrasonic Sensor 和两个直流舵机（如H桥舵机），基本步骤如下：

#include <Servo.h>
#define ECHO_PORT A0
#define TRIGGER_PIN 9
const int LEFT_SERVO_PIN = 5;
const int RIGHT_SERVO_PIN = 6;

// 初始化舵机
Servo leftServo, rightServo;

void setup() {
  Serial.begin(9600);
  pinMode(TRIGGER_PIN, OUTPUT);
  pinMode(ECHO_PORT, INPUT);

  // 初始化舵机
  leftServo.attach(LEFT_SERVO_PIN);
  rightServo.attach(RIGHT_SERVO_PIN);
}

void loop() {
  // 获取超声波传感器数据
  long duration = pulseIn(TRIGGER_PIN, HIGH, 2000);  // 高电平持续时间
  float distance = duration / 58;  // 速度公式，单位厘米

  if (distance <= 20) {  // 当距离小于20cm时，靠近物体
    // 缩小角度范围避免碰撞
    leftServo.writeMicroseconds(1000);  // 左舵机顺时针
    rightServo.writeMicroseconds(2000);  // 右舵机逆时针
  } else {  // 当距离大于20cm时，远离物体
    leftServo.writeMicroseconds(2000);  // 左舵机逆时针
    rightServo.writeMicroseconds(1000);  // 右舵机顺时针
  }

  delay(50);  // 控制刷新频率
}