树莓派3B使用超声波传感器

可乐丸子

下面介绍在树莓派3B上使用超声波传感器HC-SR04的方法

树莓派3B的GPIO定义如下

将超声波传感器的VCC GND TRIG ECHO分布连接到树莓派3B的Pin4 Pin6 Pin16 Pin18，然后上电，
登陆后输入下面代码创建hc-sr04.py

1. vi hc-sr04.py

复制代码

输入下面代码

1. import RPi.GPIO as GPIO
   
2. import time
   
3. 
   
4. trigger_pin = 23
   
5. echo_pin = 24 # USE LEVEL CONVERTER 5V->3.3V
   
6. 
   
7. GPIO.setmode(GPIO.BCM)
   
8. GPIO.setup(trigger_pin, GPIO.OUT)
   
9. GPIO.setup(echo_pin, GPIO.IN)
   
10. 
    
11. def time_to_echo(timeout):
    
12.         t0 = time.time()
    
13.         while GPIO.input(echo_pin) == False and time.time() < (t0 + timeout):
    
14.                 pass
    
15.         t0 = time.time()
    
16.         while GPIO.input(echo_pin) == True and time.time() < (t0 + timeout):
    
17.                 pass
    
18.         return time.time() - t0
    
19. 
    
20. def get_distance():
    
21.         GPIO.output(trigger_pin, True)
    
22.         time.sleep(0.00001) # 10us
    
23.         GPIO.output(trigger_pin, False)
    
24.         time.sleep(0.0002) # 200us
    
25.         pulse_len = time_to_echo(1)
    
26.         distance_cm = pulse_len / 0.000058
    
27.         distance_in = distance_cm / 2.5
    
28.         return (distance_cm, distance_in)
    
29. 
    
30. while True:
    
31.         print("cm=%f\tinches=%f" % get_distance())
    
32.         time.sleep(1)

复制代码

然后运行

1. sudo python hc-sr04.py

复制代码