#WAMpy script for reverse car parking from machine import Pin, PWM
import machine
from machine import  Pin,PWM
import time
freq=4000
trig_pin = Pin(23,Pin.OUT)
echo_pin = Pin(22,Pin.IN)
servo_pin = PWM(Pin(16),freq)

while True:
    x = 400
    trig_pin.off()
    time.sleep_us(2)
    trig_pin.on()
    time.sleep_us(10)
    trig_pin.off()
    duration =machine.time_pulse_us(echo_pin,1)
    distance = duration * 0.034 / 2
    print("distance:")
    print(distance)
    i = x - distance
    i=int(max(0,min(1023,i)))
    print(i)
    servo_pin.duty(i)
    time.sleep_ms(500)