from machine import Pin, time_pulse_us
import time
import utime
from time import sleep
from machine import PWM
from ssd1306 import SSD1306_I2C
from machine import Pin , I2C

#-------------------------------------------------------
vitesse_son = 340 #vitesse du son dan l'aire
TRIG_PULSE_US=10
#--------------------------------------------------------

led1 = Pin(1, Pin.OUT)
led2 = Pin(2, Pin.OUT)
pwm = PWM(Pin(0))
pwm.freq(50)
button = machine.Pin(6,machine.Pin.IN,machine.Pin.PULL_UP)
pos = 1
"""
i2c=I2C(0,sda=Pin(0), scl=Pin(1), freq=400000)
oled = SSD1306_I2C(128, 64, i2c)
"""
#--------------------------------------------------------

def cycleservo(position):
    pwm.duty_u16(position)
    sleep(0.01)
#--------------------------------------------------------

while True : 

    
    led2.value(1)
    print("bouton pas enfoncé")
    utime.sleep(0.1)
    if pos == 1:
        if not button.value():
            """
            oled.fill(0)
            oled.text("bouton enfoncé", 0, 0)
            oled.show()
            print("bouton enfoncé")
            """
            led1.value(1)
            led2.value(0)
            for tour in range (4500,9000,50):
                cycleservo(tour)
            pos = 0  
            utime.sleep(2)

    elif pos == 0:
        led1.value(0)
        led2.value(1)
        for tour in range(9000,4500,-50):
            cycleservo(tour)
        pos = 1