from machine import Pin, PWM
from servo import Servo
from time import sleep

servo_1 = Servo(23)
servo_2 = Servo(22)
servo_3 = Servo(21)

while True:
  servo_1.move(0)
  servo_2.move(0)
  servo_3.move(0)
  sleep(1)
  servo_1.move(90)
  sleep(1)
  servo_2.move(90)
  sleep(1)
  servo_3.move(90)
  sleep(1)
  servo_3.move(0)
  sleep(1)
  servo_2.move(0)
  sleep(1)

main.py

diagram.json

from machine import Pin, PWM

class Servo:
    def __init__(self, pin: int):
        # Init the PWM pin
        self.__pwm = PWM(Pin(pin, Pin.OUT))
        self.__pwm.freq(50)                 # 50Hz frequency

        # Convert microseconds min, max inputs to duty cycle
        # The conversion is made as:
        # dc = 550us * 65535 / 20000us = 1802
        self.mindc = 550 * 65535 // 20000
        self.maxdc = 2400 * 65535 // 20000

        self.__pwm.duty_u16(self.mindc)     # Set position to 0%

    def move(self, angle):
        ## Convert angle to DC
        dc = (((angle - 0) * (self.maxdc - self.mindc)) // 180) + self.mindc
        self.__pwm.duty_u16(dc)