import time
from machine import Pin, PWM

PIN_SERVO = 18
ARRET_US = 1500

servo = PWM(Pin(PIN_SERVO), freq=50)


def servo_us(us):
    servo.duty_u16(int(us / 20000 * 65535))


servo_us(ARRET_US)
time.sleep(2)

for v in (40, 60, 80, 100, 120, 150, 200):
    print("VITESSE_US =", v, "(", ARRET_US + v, "us )")
    servo_us(ARRET_US + v)
    time.sleep(4)
    servo_us(ARRET_US)
    time.sleep(2)

for v in (40, 80, 120):
    print("Sens inverse, VITESSE_US = -", v)
    servo_us(ARRET_US - v)
    time.sleep(4)
    servo_us(ARRET_US)
    time.sleep(2)

servo.duty_u16(0)
print("Fin du test")