from machine import Pin, PWM
from time import sleep

# Cấu hình chân servo (ví dụ chân D15)
servo = PWM(Pin(15), freq=50)

# Cấu hình 2 nút nhấn (ví dụ chân D13 và D14)
button1 = Pin(13, Pin.IN, Pin.PULL_UP)  # Nút cho 0 độ
button2 = Pin(14, Pin.IN, Pin.PULL_UP)  # Nút cho 90 độ

# Hàm đặt góc servo
def set_servo_angle(angle):
    # Góc từ 0 - 180 tương ứng duty từ 26 - 128 (tuỳ theo servo)
    duty = int((angle / 180) * 102) + 26
    servo.duty(duty)

while True:
    if button1.value() == 0:  # Nhấn nút 1
        print("Nút 1 được nhấn - Servo quay 0 độ")
        set_servo_angle(0)
        sleep(0.3)

    if button2.value() == 0:  # Nhấn nút 2
        print("Nút 2 được nhấn - Servo quay 90 độ")
        set_servo_angle(90)
        sleep(0.3)