一切开始之前，我们需要先来温习一个中学就学习过的物理原理:
常温常压下空气中的声速: 340m/s
德罕姆冲你微笑
声波雷达原理
超声波也是声波，它在1个标准大气压下，15℃的空气中的传播速度为340m/s。而声波在传播的过程中遇到障碍物时，会反射也会衍射，所以当我们测量出发出声波和听到回声的时间差，就能估算出声音传播的距离。同时因为超声波频率高波长短，所以衍射低，拘束性好，因此能量衰减也更少，传播的距离也更长，更比耳朵能听到的低频率声音更适合做长距离测量。
超声波测距原理
如上图所示，测量步骤为:
- 发出n个mHz的超声波脉冲，超声波脉冲发射结束时开始计时，记作t0
- 开始监听mHz的超声波脉冲的回声，监听到n个后结束计时，记作t1
- 计算时间差t = t1 - t0，为超声波来回两程所花费的时间
- 计算超声波走过的距离s = v * (t1 - t0) / 2(v为声速)
声波速度与空气温度的关系
声波传播速度与传播介质的温度成正比，与传输介质的密度成正比。声波在1个标准大气压下的传播速度与空气温度的关系为:
v = 331.5 + 0.607t
v为声波的速度，单位m/s
t为空气的温度，单位℃
超声波测距模块
现在市面上的超声波测距模块很多，比较常见的就算HC-SRxxx系列和US-100系列了，它们甚至可以用于汽车的倒车雷达。基本上都长这个样子，一定会有一个或者两个圆筒筒的超声波收发器。
超声波模块
目前这个超声波模块都是使用40kHz的声波，人耳可辨识的声音频率范围在20 ~ 20kHz，模块使用的声音频率超过人耳可识频率上限的2倍，完全对人类的正常生活产生影响。
它们的测距方式都是大同小异的，通常有TTL方式和GPIO方式两种，GPIO是最通用的一种控制方式，我们就用这个方式为例说明超声波测距模块的用法。
接线方式如下:
- Trigger，触发输入端，默认低电平，输入一个时常超过10μs的高电平脉冲即可触发模块发射一组超声波脉冲
- Echo，回声输出端，默认低电平，模块发射超声波脉冲结束后，回声端就会输出高电平，直到监听到所有超声波脉冲的回声（或监听超时）后才会重新输出低电平
超声波测距时序
使用步骤如下:
- 在拉高Trigger端10μs以上后拉低，以触发模块发射8个40kHz的超声波脉冲
- 开始监听Echo端，Echo输出高电平时开始计时，Echo输出低电平时结束计时
- 计算出计时的时长，即为声波一来一回花费的时间
- 计算声波走过的路程
如果想要测量得更精确，可以测量环境温度，然后如声波速度与空气温度的关系所述，利用环境温度来修正声波的速度后，再计算声波的距离。温度测量的实现方法详见[Ardunio] DS18B20温度传感器
编码实现
#define ULTRASONIC_ECHO_PIN 2
#define ULTRASONIC_TRIGGER_PIN 4
#define ULTRASONIC_DISCOVERING_STATE_PIN 13
#define ULTRASONIC_DISCOVERING_INTERVAL 500000
volatile bool mReadyToDiscovering = true;
unsigned long mEchoStartTime = 0;
unsigned long mEchoEndTime = 0;
float mDistance = 0.0f;
void trigger();
void calcDistance();
void onEcho();
bool isReadyToDiscovering();
void setup() {
Serial.begin(115200);
Serial.println();
Serial.println("Ultrasonic ranging ready");
// UltraSonic pins setup
pinMode(ULTRASONIC_ECHO_PIN, INPUT);
pinMode(ULTRASONIC_TRIGGER_PIN, OUTPUT);
pinMode(ULTRASONIC_DISCOVERING_STATE_PIN, OUTPUT);
attachInterrupt(digitalPinToInterrupt(ULTRASONIC_ECHO_PIN), onEcho, CHANGE);
// UltraSonic pins initialization
digitalWrite(ULTRASONIC_TRIGGER_PIN, LOW);
digitalWrite(ULTRASONIC_DISCOVERING_STATE_PIN, LOW);
}
void loop() {
if (isReadyToDiscovering()) {
calcDistance();
trigger();
}
}
bool isReadyToDiscovering() {
if (mReadyToDiscovering) {
unsigned long now = micros();
if (now - mEchoEndTime > ULTRASONIC_DISCOVERING_INTERVAL) {
mReadyToDiscovering = false;
return true;
}
}
return false;
}
void trigger() {
digitalWrite(ULTRASONIC_TRIGGER_PIN, HIGH);
delayMicroseconds(50);
digitalWrite(ULTRASONIC_TRIGGER_PIN, LOW);
}
void onEcho() {
uint8_t echo = digitalRead(ULTRASONIC_ECHO_PIN);
unsigned long now = micros();
if (echo == HIGH) {
mEchoStartTime = now;
digitalWrite(ULTRASONIC_DISCOVERING_STATE_PIN, HIGH);
} else {
mEchoEndTime = now;
digitalWrite(ULTRASONIC_DISCOVERING_STATE_PIN, LOW);
mReadyToDiscovering = true;
}
}
void calcDistance() {
long deltaTime = mEchoEndTime - mEchoStartTime;
mDistance = 340L * deltaTime / 2000000.0; // s = vt = 340 m/s * time / 2
Serial.print("Distance = ");Serial.print(mDistance * 100.0);Serial.print("cm, Time = ");Serial.print(deltaTime);Serial.println("us");
}
