# Motorsteuerung eines Motorbootes
# Variante 0
import machine, time

# Ansteuerung der H-Brücke
ena =  machine.PWM(machine.Pin(22))
ena.duty(0)
in1 =  machine.Pin(21, machine.Pin.OUT)
in1.value(0)
in2 =  machine.Pin(19, machine.Pin.OUT)
in2.value(0)

# Abfrage des Joysticks
horz = machine.ADC(machine.Pin(12))   # HORZ - analoger Ausgang 
vert = machine.ADC(machine.Pin(13))   # VERT - analoger Ausgang 
select = machine.ADC(machine.Pin(14)) # SEL - analoger oder digitaler Ausgang ???

# Ansteuerung des Servomotors
servo = machine.PWM(machine.Pin(23), freq=50, duty=51)

# duty-Werte 25 ... 127 entspricht 0° ... 180°
for i in range(25,127,10):
  servo.duty(i)
  print(i)
  time.sleep(0.9)
servo.duty(127)

while True:
  x = horz.read()
  y = vert.read()
  print(x,y)
  if x<1000:
    servo.duty(40)
  elif x>3000:
    pass
  else:
    pass
  if y>3000:
    print("vorwärts")
  elif y>2000:
    print("????")
  else:
    pass
  time.sleep(1.5)