import time
from machine import Pin,PWM,ADC
from picozero import Servo
import time
from machine import time_pulse_us
servo = Servo(6)
servo.min()
time.sleep(4)
trig_pin = Pin(0, Pin.OUT)
echo = Pin(1, Pin.IN)
while True:
trig_pin.value(0)
time.sleep_us(2)
trig_pin.value(1)
time.sleep_us(10)
trig_pin.value(0)
while echo.value() == 0:
signaloff = time.ticks_us()
while echo.value() == 1:
signalon = time.ticks_us()
timepassed = signalon - signaloff
distance = (timepassed * 0.0343) / 2
if distance>100:
servo.mid()
else:
servo.max()
print("The distance from object is ",distance,"cm")
time.sleep(0.5)