from machine import Pin, PWM
import time

# Define the PWM pin and frequency
servo_pin = Pin(22, Pin.OUT)
pwm = PWM(servo_pin, freq=50)

def set_servo_angle(angle):
    # Convert the angle to duty cycle
    min_duty = 25.6  # Min duty cycle (angle 0) - 2.6% of 1023
    max_duty = 128  # Max duty cycle (angle 180) - 12.3% of 1023
    duty = int((angle / 180) * (max_duty - min_duty) + min_duty)
    pwm.duty(duty)

# # Rotate servo to 0 degrees
# set_servo_angle(0)
# time.sleep(1)

# # Rotate servo to 90 degrees
# set_servo_angle(90)
# time.sleep(1)

# # Rotate servo to 180 degrees
# set_servo_angle(180)
# time.sleep(1)

while True :
    set_servo_angle(90)
    time.sleep(1)
    set_servo_angle(180)
    time.sleep(1)

# Clean up
pwm.deinit()