樹莓派智慧四輪小車實現超聲波測距
阿新 • • 發佈:2018-12-11
#! /usr/bin/python
# -*- coding:utf-8 -*-
import RPi.GPIO as GPIO
import time
import RPi.GPIO as GPIO
import time
def checkdist():
#發出觸發訊號 GPIO.output(2,GPIO.HIGH) #保持10us以上(我選擇15us) time.sleep(0.000015) GPIO.output(2,GPIO.LOW) while not GPIO.input(3): pass #發現高電平時開時計時 t1 = time.time() while GPIO.input(3): pass #高電平結束停止計時 t2 = time.time() #返回距離,單位為米 return (t2-t1)*340/2
GPIO.setmode(GPIO.BCM)
#第3號針,GPIO2
GPIO.setup(2,GPIO.OUT,initial=GPIO.LOW)
#第5號針,GPIO3
GPIO.setup(3,GPIO.IN)
time.sleep(2)
try:
while True:
print 'Distance: %0.2f m' %checkdist()
time.sleep(0.5)
except KeyboardInterrupt:
GPIO.cleanup()```
正常!!