前言:
今天大家对“超声波模块测距算法”大约比较关心,看官们都想要学习一些“超声波模块测距算法”的相关资讯。那么小编也在网络上收集了一些对于“超声波模块测距算法””的相关资讯,希望同学们能喜欢,小伙伴们快快来学习一下吧!关注《高手杰瑞》获得更多好玩资讯!
初识HC-SR04超声波测距模块
超声波测距模块其实有很多种,其中HC-SR04是我们较为常见的一种型号,在这里我们使用HC-SR04超声波测距模块来实现我们的测距功能。HC-SR04支持2cm-400cm之间的非接触式距离测量功能,测量精度可以到达3mm!该模块集成了超声波发射器、接收器和其他控制电路等。
模块驱动方法:
向TRIG口输出至少持续10us的高电平信号,在这之后模块内部控制电路将自动发送8个40khz的方波,并自动检测是否有信号返回,若有信号返回,模块ECHO将会输出一个高电平,持续时间就是超声波从发射到返回的时间。
下图为HC-SR04超声波模块的时序图:
编写HC-SR04的驱动程序
按照上述的驱动方式,我们可以来编写HC-SR04的驱动程序。杰瑞在这里使用Python来编写HC-SR04的驱动程序,在编写之前我们的树莓派中必须要提前安装好RPi.GPIO库。
按照惯例导入我们需要用到的库:
import RPi.GPIOimport time
设置树莓派IO口的编码方式为BCM,并屏蔽警告信息
GPIO.setwarnings(False)GPIO.setmode(GPIO.BCM)
定义TRIG、ECHO引脚。
#定义 GPIO引脚GPIO_TRIGGER = 23GPIO_ECHO = 24GPIO.setup(GPIO_TRIGGER, GPIO.OUT)GPIO.setup(GPIO_ECHO, GPIO.IN)
我们的准备工作做完了,接下来就按照上面的驱动方式来编写驱动代码:
1.向TRIG引脚输出持续10us的高电平信号
#发送高电平信号给 trig引脚 GPIO.output(GPIO_TRIGGER, True) #持续 10 us time.sleep(0.00001) GPIO.output(GPIO_TRIGGER, False)计算超声波从发射到接收的时间
start_time = time.time() stop_time = time.time() #记录超声波发送时刻 while GPIO.input(GPIO_ECHO) == 0: start_time = time.time() while GPIO.input(GPIO_ECHO) == 1: stop_time = time.time()利用公式计算距离(单位cm)
#计算超声波返回的时间 time_elapsed = stop_time - start_time #空气中声波的速度为 343m/s ,转化为 34300cm/s distance = (time_elapsed * 34300) / 2循环检测并输出测试得到的距离:
if __name__ == '__main__': try: while True: dist = distance() print("检测到物体距离{:.2f} cm".format(dist)) time.sleep(1) # Reset by pressing CTRL + C except KeyboardInterrupt: print("Measurement stopped by User") GPIO.cleanup()接线方式
HC-SR04模块的VCC接树莓派的5伏VCC上,GND与树莓派GND相连,TRIG、ECHO分别于23、24号IO口连接。
效果测试
先看一下整体连接效果图:
以下是程序运行测试出来的数据:
源码获取
关注《高手杰瑞》并转发,私信关键字:“超声波模块源码”即可获取源码!
文中需要用到的硬件设备如下:
HC-SR04超声波测距模块