#Simon Afrim 5J

# Bibliothèque
from machine import Pin, time_pulse_us
from time import sleep
from servo import Servo 
import time

#Déclatration de variable

vitesse_son = 340
__servo_pwm_freq = 50
servo = Servo (pin=8)
ledV = Pin(0, Pin.OUT)
ledR = Pin(5, Pin.OUT)
echo = Pin(16, Pin.IN)
trig = Pin(17, Pin.OUT)
TRIG_PULSE_US=10

#Code

while True:
    trig.value(0)

    trig.value(1)
    time.sleep_us(TRIG_PULSE_US)
    trig.value(0)
 
    ultrason = time_pulse_us(echo, 1, 30000)
    distance = vitesse_son * ultrason / 20000
    print (f"Distance : {distance} cm" )
    time.sleep_ms(1000)

    if distance < 150: 
        servo.move(0)
        ledR.value(1)
        ledV.value(0)

    else:
        servo.move(180)
        ledV.value(1)
        ledR.value(0)