from machine import Pin, PWM
from time import sleep

servo = PWM(Pin(15))
servo.freq(50)

button = Pin(14, Pin.IN, Pin.PULL_UP)

asennot = [0, 90, 180]
i = 0

def kulma(a):
    duty = int(1638 + (a / 180) * 4915)
    servo.duty_u16(duty)

while True:
    # Servo liikkuu edestakaisin eri kulmiin
    for a in [0, 90, 180, 90]:
        kulma(a)
        sleep(1)

        # Jos painiketta painetaan, vaihdetaan asentoa
        if button.value() == 0:
            i = i + 1

            if i >= len(asennot):
                i = 0

            kulma(asennot[i])
            sleep(0.5)