先介绍一下超声波模块:
总共有四个端子,分别为VCC、GND、Trig、Echo。
VCC一般接5V电压;GND接地
Trig为输出接口,Echo为输入接口
Trig和Echo与超声波测距原理有关,
接下来介绍超声波测距原理:
超声波进行测距的时候,首先需要输出一个10us左右的高电平,这个高电平意味着要开始一次测量了,我们由Tring 这个端口给出高电平,代码如下:
digitalWrite(Trig,HIGH); //我们先把Trig写为高电平
delay(10); //延时10us
digitalWrite(Trig,LOW); //回到低电平
开始测量之后,Echo就会跳到高电平,知道发出去的波回来为止,因此Echo为高电平的时间就是波从发出去到障碍物再从障碍物回来所用的时间,这个时间乘以速度就是距离。
测量时间因为我们刚好有pulseIn函数,所以可以简单的得到时间。
测量时间的代码如下:
return p