"""Simulation: Serielle Daten einlesen und verarbeiten"""

import machine, time

def Servo(servo, angle):
  servo.duty(int(((angle)/180 *2 + 0.5) / 20 * 1023))

servo1 = machine.PWM(machine.Pin(23), freq=50, duty=25)
servo1_aktiv=True

servo2 = machine.PWM(machine.Pin(22), freq=50, duty=25)
servo2_aktiv=True

time.sleep(1.5)

Servo(servo1,90)
Servo(servo2,90)

eingabe=""
print("s1 w1 s2 w2")
while eingabe!="x":
    eingabe = input("Deine Eingabe: ")
    (s1, w1, s2, w2) = eingabe.split(" ")
    # Auswertung für Servo 1
    if s1=="0":
        if servo1_aktiv:
            Servo(servo1,int(w1))
            time.sleep(1)
            servo1.deinit()
            servo1_aktiv = False
    elif s1=="1":
        if not servo1_aktiv:
            servo1 = machine.PWM(machine.Pin(23), freq=50, duty=25)
            servo1_aktiv=True
        Servo(servo1,int(w1))
    else:
        pass