from machine import Pin, PWM, ADC
from time import sleep
import utime

# Inisialisasi
pot = ADC(26)  # GP26 = ADC0
servo = PWM(Pin(16))
buzzer = PWM(Pin(14))

# Konfigurasi PWM
servo.freq(50)        # 50 Hz untuk servo
buzzer.freq(1000)     # Awal frekuensi buzzer

# Fungsi untuk mapping
def map_value(value, in_min, in_max, out_min, out_max):
    return int((value - in_min) * (out_max - out_min) / (in_max - in_min) + out_min)

while True:
    val = pot.read_u16()  # Baca nilai ADC 16-bit (0 - 65535)

    # === Servo Motor ===
    pot_value = pot.read_u16()
    angle = map_value(pot_value, 0, 65535, 180, 0)
    duty = map_value(angle, 0, 180, 1500, 7500)
    servo.duty_u16(duty)

    # Debugging
    print(f"Pot Value: {pot_value}, Angle: {angle}, Duty: {duty}")

    # === Buzzer ===
    if 0 < angle < 180:
        # Jika sudut servo lebih dari 0 dan kurang dari 180
        freq = int(200 + (val / 65535) * (2000 - 200))  # Map ke 200-2000 Hz
        buzzer.freq(freq)
        buzzer.duty_u16(30000)  # Buzzer bunyi
    else:
        buzzer.duty_u16(0)      # Buzzer mati

    sleep(0.05)