from machine import Pin, PWM
from time import sleep


servo_pins = [33, 32, 14, 27, 26, 25]


servos = []
for pin in servo_pins:
    servo = PWM(Pin(pin), freq=50)
    servos.append(servo)


def set_angle(servo, angle):
    duty = int((angle / 180) * 102 + 26)
    servo.duty(duty)

while True:

 
    angulos = [0, 30, 60, 90, 120, 180]
    for servo, angulo in zip(servos, angulos):
        set_angle(servo, angulo)
    sleep(1)


    angulos = [180, 150, 120, 90, 60, 0]
    for servo, angulo in zip(servos, angulos):
        set_angle(servo, angulo)
    sleep(1)

    
    angulos = [45, 90, 135, 180, 45, 90]
    for servo, angulo in zip(servos, angulos):
        set_angle(servo, angulo)
    sleep(1)