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

版权声明:转载请注明原文地址即可,要是本文对您有些许帮助的话,请您在下方点个赞,谢谢啦ヾ(o◕∀◕)ノヾ https://blog.csdn.net/qq_33583069/article/details/88606727


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

猜你喜欢

转载自blog.csdn.net/qq_33583069/article/details/88606727
今日推荐