from machine import ADC, Pin
from utime import sleep_ms
from moon_servo import moon_servo

# Create servo object
servo = moon_servo(21)
servo2 = moon_servo(15)
servo.connect()
servo2.connect()

# Configure potentiometer
pot = ADC(Pin(34))
pot.atten(ADC.ATTN_11DB)      # Read full 0-3.3V range
pot.width(ADC.WIDTH_12BIT)    # 0-4095
pot2 = ADC(Pin(32))
pot2.atten(ADC.ATTN_11DB)      # Read full 0-3.3V range
pot2.width(ADC.WIDTH_12BIT)    # 0-4095

previous_angle = -1
previous_angle2 = -1
while True:
    # Read potentiometer
    pot_value = pot.read()    # 0-4095

    # Convert to 0-180 degrees
    angle = int((pot_value / 4095) * 180)

    # Move only if angle changes
    if angle != previous_angle:
        servo.move(angle)
        print("Pot:", pot_value, "Angle:", angle)
        previous_angle = angle

    # Read potentiometer
    pot2_value = pot2.read()    # 0-4095

    # Convert to 0-180 degrees
    angle_2 = int((pot2_value / 4095) * 180)

    # Move only if angle changes
    if angle_2 != previous_angle2:
        servo2.move(angle_2)
        print("Pot:", pot2_value, "Angle:", angle_2)
        previous_angle2 = angle_2

    sleep_ms(20)