from machine import Pin, PWM
import time

# Setup servo on pin 0
servo = PWM(Pin(0))
servo.freq(50)

def set_angle(angle):
    # Correct duty range for Wokwi + Pico
    min_u16 = 1638     # ~0.5 ms pulse
    max_u16 = 8192     # ~2.5 ms pulse
    duty = int(min_u16 + (angle / 180) * (max_u16 - min_u16))
    servo.duty_u16(duty)

print("System online, mane.")

while True:
    cmd = input("Trigga bot: ").strip().lower()

    if cmd == "left":
        set_angle(0)
        print("Turning left, mane.")

    elif cmd == "center":
        set_angle(90)
        print("Centering up, bruh.")

    elif cmd == "right":
        set_angle(180)
        print("Whippin' right, mane.")

    elif cmd == "taco bell chicken chaloupa":
        print("Aight mane, shutting down.")
        break

    else:
        print("Sorry mane, that's no command bruh.")