from machine import Pin, PWM
from time import sleep

servo1 = PWM(Pin(27))
servo1.freq(50)

servo2 = PWM(Pin(26))
servo2.freq(50)

def servo_angle1(angle):
    min_duty = 25   # Nilai PWM minimum (0°)
    max_duty = 125  # Nilai PWM maksimum (180°)
    duty = min_duty + (angle / 180) * (max_duty - min_duty)
    servo1.duty(int(duty))  # Tetapkan duty cycle

def servo_angle2(angle):
    min_duty = 25   # Nilai PWM minimum (0°)
    max_duty = 125  # Nilai PWM maksimum (180°)
    duty = min_duty + (angle / 180) * (max_duty - min_duty)
    servo2.duty(int(duty))  # Tetapkan duty cycle

while True:
    servo_angle1(0)
    servo_angle2(180)
    sleep(1)
    servo_angle1(90)
    servo_angle2(90)
    sleep(1)
    servo_angle1(180)
    servo_angle2(0)
    sleep(1)