from machine import Pin, PWM
from time import sleep

# Set up PWM Pin for servo control
servo1_pin = machine.Pin(19)
servo2_pin = machine.Pin(18)
servo1 = PWM(servo1_pin)
servo2 = PWM(servo2_pin)

# Set Duty Cycle for Different Angles
max_duty = 8500
min_duty = 1300 
half_duty = int(max_duty/2)

#Set PWM frequency
frequency = 50
servo1.freq (frequency)
servo2.freq (frequency)


try:
    count = 1300
    while True:
        #Servo at 0 degrees
        servo1.duty_u16(min_duty)
        servo2.duty_u16(max_duty)
        print("0")
        sleep(2)
        #Servo at 90 degrees
        servo1.duty_u16(half_duty)
        servo2.duty_u16(half_duty)
        print("90")
        sleep(2)
        #Servo at 180 degrees
        servo1.duty_u16(min_duty)
        servo2.duty_u16(max_duty)
        print("0")
        sleep(2)    
      
except KeyboardInterrupt:
    print("Keyboard interrupt")
    # Turn off PWM 
    servo1.deinit()
    servo2.deinit()