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

servo = Servo(22)
while True:
    # Test the function
    servo.set_angle(0)    # set to 0°
    time.sleep(1)
    servo.set_angle(90)   # set to 90°
    time.sleep(1)
    servo.set_angle(180)  # set to 180°
    time.sleep(1)

main.py

diagram.json

from machine import Pin, PWM

class Servo:
    def __init__(self, pin_number):
        """
        Initializes the SG90 servo motor on the given pin number.

        :param pin_number: The pin where the servo control wire is connected.
        """
        self._servo = PWM(Pin(pin_number, mode=Pin.OUT))
        self._servo.freq(50)
        self._min_duty = 26
        self._max_duty = 123

    def set_angle(self, angle):
        """
        Set the angle of the servo.

        :param angle: Desired angle in degrees (0-180).
        """
        if 0 <= angle <= 180:
            duty = self._min_duty + (angle / 180) * (self._max_duty - self._min_duty)
            self._servo.duty(int(duty))
        else:
            print("Error: Angle out of range!")

    def deinit(self):
        """
        De-initializes the servo.
        """
        self._servo.deinit()

# Usage example:
# servo = SG90Servo(22)
# servo.set_angle(90)
# servo.deinit()
