from machine import Pin, PWM
import time
from hcsr04 import HCSR04



led_verte = Pin(27, Pin.OUT)
led_rouge = Pin(28, Pin.OUT)
servo = PWM(Pin(20), freq=50)

trig = Pin(3, Pin.OUT)
echo = Pin(4, Pin.IN)

capteur = HCSR04(echo_timeout_us = 10000)

while True:
    distance = capteur.distance_cm()
    if distance <= 100:
        led_verte.on()
        led_rouge.off()

        
        servo.duty_u16(120)
        time.sleep(2)
        servo.duty_u16(30)
    else:
        led_rouge.on()
        led_verte.off()

        
        servo.duty_u16(30)

    time.sleep(0.1)