-
Notifications
You must be signed in to change notification settings - Fork 0
/
Copy pathdistance.py
40 lines (35 loc) · 929 Bytes
/
distance.py
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
import RPi.GPIO as GPIO
import time
GPIO.setmode(GPIO.BCM)
TRIG = 17
ECHO = 18
print("Distance Measurement In Progress")
GPIO.setup(TRIG,GPIO.OUT)
GPIO.setup(ECHO,GPIO.IN)
GPIO.output(TRIG, False)
print("Waiting For Sensor To Settle")
time.sleep(2)
def measure():
pulse_duration = 0
for i in range(5):
GPIO.output(TRIG, True)
time.sleep(0.00001)
GPIO.output(TRIG, False)
while GPIO.input(ECHO)==0:
pulse_start = time.time()
while GPIO.input(ECHO)==1:
pulse_end = time.time()
# print(pulse_end - pulse_start)
pulse_duration += (pulse_end - pulse_start)
pulse_duration /= 5
distance = pulse_duration * 17150
distance = round(distance, 2)
return distance
try:
while True:
dist = measure()
print("Distance: {}cm".format(dist))
time.sleep(0.5)
except KeyboardInterrupt:
pass
GPIO.cleanup()