from machine import Pin, Timer, PWM, ADC
from time import sleep
led = Pin("LED", Pin.OUT)
led.on()
angle = 0

# Set up PWM Pin for servo control
servo_pin = machine.Pin(16)
servo = PWM(servo_pin)
frequency = 50
servo.freq (frequency)

# Set Duty Cycle for Different Angles
max_duty = 8000    #try 8500
min_duty = 1500    #try 1300
custom = 0
Angle = 0
servo.duty_u16(min_duty)

try:
    while True:
        angle = int(input("Angle"))
        print(angle)
        custom = angle
        Angle = int(custom/180*6500) + 1500    
        print(Angle)
        if Angle >8000:
            print("angle is to big")
        elif Angle <1500:
            print("angle is to small")
        else:
            servo.duty_u16(Angle)

     
except KeyboardInterrupt:
    print("Keyboard interrupt")
    # Turn off PWM
    servo.deinit()