from utime import  sleep_ms
from machine import Pin, PWM

class ServoMotor():
    def __init__(self, pin):
        self.pwm = PWM(Pin(pin), freq=50, duty=0)
        self.prev = 0

    def set(self, speed):
        if self.prev == speed:
            # Prevent jerkiness
            return
        self.prev = speed
        if speed == 0:
            self.pwm.duty(0)
        else:
            self.pwm.duty(int(33 + speed * 66 / 100))
        print(self.pwm, 33 + speed * 66 / 100)

left_motor = ServoMotor(13)
right_motor = ServoMotor(15)

while True:
    left_motor.set(100)
    right_motor.set(0)
    sleep_ms(500)
    left_motor.set(0)
    right_motor.set(100)
    sleep_ms(500)