"""
capteur a ultra son
2 leds rouge vert  
un servo
 
le servo s'ouvre a moins d'1 metre et la led verte s'allume et a plus d'1 metre la lettre rouge s'allume
print de bienvenue quand la porte s'ouvre
 
"""
from machine import Pin, time_pulse_us, PWM
import time

vitesse_son = 340
trigger_pin = Pin(7, Pin.OUT)
echo_pin = Pin(6, Pin.IN)

led1_pin = Pin(5, Pin.OUT)
led2_pin = Pin(3, Pin.OUT)
servo_pin = Pin(4, Pin.OUT)
servo = PWM(servo_pin, freq=50)
servo.duty_ns(1000000)

def distance():
    trigger_pin.value(1)
    time.sleep_us(10)
    trigger_pin.value(0)
   
    ultrason = time_pulse_us(echo_pin, 1, 30000)
    distance_cm = vitesse_son * ultrason / 20000

    return distance_cm

while True:
    dist = distance()

    if dist < 100:
        led1_pin.value(0)
        led2_pin.value(1)
        servo.duty_ns(200000)
        time.sleep(0.1)