超声波测距仪子程序

以下是一个基于Arduino平台的超声波测距仪子程序的示例代码：

#define trigPin 9
#define echoPin 10

void setup() {
  pinMode(trigPin, OUTPUT);
  pinMode(echoPin, INPUT);
  Serial.begin(9600);
}

void loop() {
  long duration, distance;

  digitalWrite(trigPin, LOW);
  delayMicroseconds(2);

  digitalWrite(trigPin, HIGH);
  delayMicroseconds(10);
  digitalWrite(trigPin, LOW);

  duration = pulseIn(echoPin, HIGH);

  distance = (duration/2) / 29.1;

  if (distance >= 200 || distance <= 0) {
    Serial.println("Out of range");
  }
  else {
    Serial.print(distance);
    Serial.println(" cm");
  }

  delay(500);
}

该程序使用了Arduino的数字引脚9和10分别连接超声波测距仪的Trig和Echo引脚。程序通过向Trig引脚发送10微秒的脉冲，触发超声波模块发射一次超声波信号，然后通过pulseIn()函数测量Echo引脚上的高电平持续时间，计算出距离值并输出到串口监视器上。程序每隔500毫秒执行一次测量。