使用超声波传感器控制舵机的程序编写指南

01核心原理与硬件连接

核心原理是，系统借助超声波传感器去测量前方障碍物的距离，微控制器像，依据设定好的距离阈值，进而生成相应的PWM也就是脉宽调制信号，以此来控制舵机的转动角度。距离越接近，舵机转向的角度或许越大，又或许越小，这全然取决于您的程序逻辑设计。

硬件连接（以为例）：

1. 超声波传感器（如HCSR04）：

VCC 接 5V。

GND 接 GND。

Trig (触发) 接 数字引脚 9。

Echo (回声) 接 数字引脚 10。

2. 舵机（如SG90）：

红色线 (VCC) 接 5V。

棕色/黑色线 (GND) 接 GND。

关键暗示：为防止舵机运作之际电流过度致使发生复位状况产生提示，提议为舵机供给单独电源（要求共同接地），或者采用大容量电容进行滤波处理。

02核心程序代码与逐行解析

下面是能够直接上传到 IDE的核心程序，这个程序达成的功能是，在检测到障碍物距离小于20厘米之际，舵机转动到90度的位置，要不然，舵机返回0度的位置。

// 1. 引入舵机库并定义引脚
#  // 使用内置的Servo库
Servo ;     // 创建一个舵机对象
const int  = 9;   // 超声波触发引脚
const int  = 10;  // 超声波回声引脚
const int  = 6;  // 舵机信号引脚
// 2. 定义距离阈值（单位：厘米）
const int  = 20;
void setup() {
  .begin(9600);        // 初始化串口，用于调试输出距离值
  (, );  // 设置触发引脚为输出模式
  (, INPUT);   // 设置回声引脚为输入模式
  .();  // 将舵机对象绑定到指定引脚
  .write(0);          // 初始化舵机角度为0度
}
void loop() {
  // 3. 核心步骤：获取超声波测距结果
  long , ;
  (, LOW);
  (2);
  (, HIGH); // 发送一个10微秒的高脉冲触发信号
  (10);
  (, LOW);
   = (, HIGH); // 读取高电平持续时间
   =   0.034 / 2;   // 将时间转换为距离（单位：厘米）
  // 4. 将距离值打印到串口监视器，便于调试
  .print(": ");
  .print();
  .(" cm");
  // 5. 核心控制逻辑：根据距离控制舵机
  if ( <  &&  > 0) {
    // 如果检测到障碍物在阈值范围内，舵机转到90度
    .write(90);
    .(" ! Servo moved to 90 deg.");
  } else {
    // 否则，舵机回到0度
    .write(0);
  }
  delay(100); // 添加短暂延时，避免舵机频繁动作
}

03调试与行动建议