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 

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()  # Nilai ADC 16-bit (0 - 65535) 
    # === Servo Motor === 
    # Membaca nilai potensiometer (0 - 65535) 
    pot_value = pot.read_u16()

    # Konversi ke sudut servo (0° - 180°) 
    angle = map_value(pot_value, 0, 65535, 0, 180) 

    # Konversi sudut ke duty cycle (1500 - 7500) → sesuai servo PWM 
    duty = map_value(angle, 0, 180, 1500, 7500) 
    servo.duty_u16(duty) 

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

    # === Buzzer === 
    # Buzzer hanya aktif saat sudut antara 0° dan 180° eksklusif
    if 0 < angle < 180:
        # Ubah val ke frekuensi (200 Hz - 2000 Hz) 
        freq = int(200 + (val / 65535) * (2000 - 200)) 
        buzzer.freq(freq) 
        buzzer.duty_u16(30000)  # Volume/suaranya 
    else:
        buzzer.duty_u16(0)             # Matikan suara

    sleep(0.05)