Arduino 超声波模块测距 示例程序

时间:2024-02-20 10:59:02


Trig 触发控制信号输入,Echo回响信号输出。写程序给Trig发送一个低高低的短时间脉冲,触发测距;pulseIn函数会等待引脚变为HIGH,开始计算时间,再等待变为LOW并停止计时。
声速是:340m/1s 换算成 34000cm/ 1000000μs => 34 /1000。因为发送到接收,实际是相同距离走了2回,所以要除以2。
距离(厘米) = (回波时间 * (34 / 1000)) / 2, 简化后的计算公式为 (回波时间 * 17)/ 1000

#define TRIG 12
#define ECHO 11
float cm;
float tmp;
void setup(){
  Serial.begin(9600);
  pinMode(TRIG,OUTPUT);
  pinMode(ECHO,INPUT);
}
void loop(){
  digitalWrite(TRIG,LOW);
  delayMicroseconds(2);
  digitalWrite(TRIG,HIGH);
  delayMicroseconds(10);
  digitalWrite(TRIG,LOW);
  tmp=float(pulseIn(ECHO,HIGH));
  cm=(tmp*17)/1000;
  Serial.print("Echo=");
  Serial.print(tmp);
  Serial.print(",Distance=");
  Serial.print(cm);
  Serial.println("cm");
  delay(300);
}

推荐一篇详细的文章:click here