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