#include <SR04.h>
SR04 ultrasonic = SR04(2,3);
void setup()
{
Serial.begin(9600);
}
void loop()
{
float distance=ultrasonic.GetDistance();
Serial.print(distance);
Serial.print("cm");
Serial.println();
delay(100);
}
SR04的成员函数GetDistance()的重写
float GetDistance (int TrigPin,int EchoPin)
{
//产生一个10μs的高脉冲去触发TrigPin
digitalWrite(TrigPin, LOW);
delayMicroseconds(2);
digitalWrite(TrigPin, HIGH);
delayMicroseconds(10);
digitalWrite(TrigPin, LOW);
float distance = pulseIn(EchoPin, HIGH) / 58.00;
return distance;
}
距离:L = (1/2) * 340 *(time /10^6) * 100 = time / 58
因为时间T是超声波来回两段路程的时间,所以要除以2,计算过程包括了把us变成s , 速度乘时间, m变成cm 三个部分。
关于电平的解释:
1、使用Arduino采用数字引脚给SR04的Trig引脚至少10μs的高电平信号,触发SR04模块测距功能;
2、触发后,模块会自动发送8个40KHz的超声波脉冲,并自动检测是否有信号返回。这步会由模块内部自动完成。
3、如有信号返回,Echo引脚会输出高电平,高电平持续的时间就是超声波从发射到返回的时间。此时,我们能使用pulseIn()函数获取到测距的结果,并计算出距被测物的实际距离。
关于pulseIn():
用于检测引脚输出的高低电平的脉冲宽度。
pulseIn(pin, value)
Pin:需要读取脉冲的引脚
Value:需要读取的脉冲类型,HIGH或LOW