/
range_finder.py
34 lines (26 loc) · 993 Bytes
/
range_finder.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
# Range finder
from machine import Pin
from time import sleep, sleep_us, ticks_us
class RangeFinder():
def __init__(self,trigger_pin:int = 0, echo_pin:int = 1):
self.trigger = Pin(trigger_pin, Pin.OUT)
self.echo = Pin(echo_pin, Pin.IN)
def distance(self):
""" Returns the distance in cm """
# set the signal on & off times to zero
signalon = 0
signaloff = 0
# reset the trigger
self.trigger.low()
sleep_us(2)
self.trigger.high()
sleep_us(5)
self.trigger.low()
while self.echo.value() == 0:
signaloff = ticks_us()
while self.echo.value() == 1:
signalon = ticks_us()
elapsed_microseconds = signalon - signaloff
self.duration = elapsed_microseconds
self.distance_to_object = (elapsed_microseconds * 0.343) / 2
return round(self.distance_to_object / 10 ,1)