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)