1. 程式人生 > >樹莓派智慧四輪小車實現超聲波測距

樹莓派智慧四輪小車實現超聲波測距

模組定義

#! /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()```

正常!! 在這裡插入圖片描述