from machine import Pin, ADC, PWM
import utime

# Joystick
xAxis = ADC(Pin(27))
yAxis = ADC(Pin(26))
button = Pin(16, Pin.IN, Pin.PULL_UP)

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

def droite(angle_actuelle, pos_joystick):
  # position actuel du servo - 200 estompé
  new_angle = int(round(angle_actuelle/10.08 - 200, 1))
  return new_angle

new_xValue = 0
servoValue = 0
angle_actuel = 4750

cptr = 0
while True:

  servo.duty_u16(angle_actuel)

  # Joystick
  xValue = xAxis.read_u16()
  yValue = yAxis.read_u16()
  buttonValue = button.value()
  print(str(xValue) + ", " + str(yValue) + ", " + str(buttonValue))
  print('Angle actuel: ' + str(angle_actuel))

  # Servo
  #servo.duty_u16(int(round((xValue/10)+1499, 1)))

  utime.sleep(0.02)

  if xValue > 32759:
    print('droite')
    if angle_actuel < 8000:
      angle_actuel += 40

  if xValue < 32759:
    print('gauche')
    if angle_actuel > 1500:
      angle_actuel -= 40

  if buttonValue == 0:
    angle_actuel = 4750