from machine import Pin,PWM
import time

s1 = PWM(Pin(14),freq=50, duty=128)
s2 = PWM(Pin(16),freq=56, duty=128)
s3 = PWM(Pin(17),freq=56, duty=128)
s4 = PWM(Pin(2),freq=56, duty=128)
s5 = PWM(Pin(4),freq=56, duty=128)
def rotate(Servo,degree):
    Servo.duty(int (25.6+degree*0.54+25.6))
while 1:
    t=50
    for i  in range(0,180,10):
        rotate(s1,i)
        time.sleep_ms(t)
    for i  in range(180,0,-10):
        rotate(s1,i)
        time.sleep_ms(t)
    for i  in range(0,180,10):
        rotate(s2,i)
        time.sleep_ms(t)
    for i  in range(180,0,-10):
        rotate(s2,i)
        time.sleep_ms(t)
    for i  in range(0,180,10):
        rotate(s3,i)
        time.sleep_ms(t)
    for i  in range(180,0,-10):
        rotate(s3,i)
        time.sleep_ms(t)
    for i  in range(0,180,10):
        rotate(s4,i)
        time.sleep_ms(t)
    for i  in range(180,0,-10):
        rotate(s4,i)
        time.sleep_ms(t)
    for i  in range(0,180,10):
        rotate(s5,i)
        time.sleep_ms(t)
    for i  in range(180,0,-10):
        rotate(s5,i)
        time.sleep_ms(t)

    for i  in range(0,10,-10):
        rotate(s1,i)
        time.sleep_ms(t)
    for i  in range(10,0,-10):
        rotate(s1,i)
        time.sleep_ms(t)
    for i  in range(0,30,10):
        rotate(s2,i)
        time.sleep_ms(t)
    for i  in range(30,0,-10):
        rotate(s2,i)
        time.sleep_ms(t)
    for i  in range(0,40,10):
        rotate(s3,i)
        time.sleep_ms(t)
    for i  in range(40,0,-10):
        rotate(s3,i)
        time.sleep_ms(t)
    for i  in range(0,50,10):
        rotate(s4,i)
        time.sleep_ms(t)
    for i  in range(50,0,-10):
        rotate(s4,i)
        time.sleep_ms(t)
    for i  in range(0,90,-10):
        rotate(s5,i)
        time.sleep_ms(t)
    for i  in range(90,0,-10):
        rotate(s5,i)
        time.sleep_ms(t)
        
    for i  in range(0,90,-10):
        rotate(s1,i)
        time.sleep_ms(t)
    for i  in range(90,0,-10):
        rotate(s1,i)
        time.sleep_ms(t)
    for i  in range(0,90,10):
        rotate(s2,i)
        time.sleep_ms(t)
    for i  in range(90,0,-10):
        rotate(s2,i)
        time.sleep_ms(t)
    for i  in range(0,90,10):
        rotate(s3,i)
        time.sleep_ms(t)
    for i  in range(90,0,-10):
        rotate(s3,i)
        time.sleep_ms(t)
    for i  in range(0,90,10):
        rotate(s4,i)
        time.sleep_ms(t)
    for i  in range(90,0,-10):
        rotate(s4,i)
        time.sleep_ms(t)
    for i  in range(0,90,10):
        rotate(s5,i)
        time.sleep_ms(t)
    for i  in range(90,0,-10):
        rotate(s5,i)
        time.sleep_ms(t)
    for i  in range(0,90,-10):
        rotate(s5,i)
        time.sleep_ms(t)

    for i  in range(0,50,-10):
        rotate(s1,i)
        time.sleep_ms(t)
    for i  in range(50,0,-10):
        rotate(s1,i)
        time.sleep_ms(t)
    for i  in range(0,50,10):
        rotate(s2,i)
        time.sleep_ms(t)
    for i  in range(50,0,-10):
        rotate(s2,i)
        time.sleep_ms(t)
    for i  in range(0,50,10):
        rotate(s3,i)
        time.sleep_ms(t)
    for i  in range(50,0,-10):
        rotate(s3,i)
        time.sleep_ms(t)
    for i  in range(0,50,10):
        rotate(s4,i)
        time.sleep_ms(t)
    for i  in range(50,0,-10):
        rotate(s4,i)
        time.sleep_ms(t)
    for i  in range(0,50,10):
        rotate(s5,i)
        time.sleep_ms(t)
    for i  in range(50,0,-10):
        rotate(s5,i)
        time.sleep_ms(t)

    for i  in range(0,70,-10):
        rotate(s1,i)
        time.sleep_ms(t)
    for i  in range(70,0,-10):
        rotate(s1,i)
        time.sleep_ms(t)
    for i  in range(0,70,10):
        rotate(s2,i)
        time.sleep_ms(t)
    for i  in range(70,0,-10):
        rotate(s2,i)
        time.sleep_ms(t)
    for i  in range(0,70,10):
        rotate(s3,i)
        time.sleep_ms(t)
    for i  in range(70,0,-10):
        rotate(s3,i)
        time.sleep_ms(t)
    for i  in range(0,70,10):
        rotate(s4,i)
        time.sleep_ms(t)
    for i  in range(70,0,-10):
        rotate(s4,i)
        time.sleep_ms(t)
    for i  in range(0,70,10):
        rotate(s5,i)
        time.sleep_ms(t)
    for i  in range(70,0,-10):
        rotate(s5,i)
        time.sleep_ms(t)