from machine import Pin, ADC
import time

# --- Setup ---

vrx = ADC(Pin(34))
vry = ADC(Pin(35))
vrx.atten(ADC.ATTN_11DB)   # full 0-3.3 V range
vry.atten(ADC.ATTN_11DB)

button = Pin(32, Pin.IN, Pin.PULL_UP)   # active LOW: 0 = pressed

# Dead-zone thresholds (center ~2048, ±35%)
DEAD_LOW = 1300
DEAD_HIGH = 2800


def read_direction():
    """Return 'STOP' / 'LEFT' / 'RIGHT' / 'UP' / 'DOWN'."""
    x = vrx.read()
    y = vry.read()

    x_out = x < DEAD_LOW or x > DEAD_HIGH
    y_out = y < DEAD_LOW or y > DEAD_HIGH

    if not x_out and not y_out:
        return "STOP", x, y

    # The axis with the larger deflection from center wins
    dx = x - 2048
    dy = y - 2048
    if abs(dx) >= abs(dy):
        return ("LEFT" if x < DEAD_LOW else "RIGHT"), x, y
    else:
        return ("UP" if y < DEAD_LOW else "DOWN"), x, y


print("Move the stick. Ctrl+C to stop.\n")

last_dir = None
while True:
    direction, x, y = read_direction()
    pressed = button.value() == 0   # 0 = pressed

    # Only print when the direction or the button changes
    if direction != last_dir or pressed:
        print(f"X={x:4d}  Y={y:4d}  →  {direction}{'  [BTN]' if pressed else ''}")
        last_dir = direction

    time.sleep_ms(50)

# Hold the stick centered and read 10 samples
samples_x = [vrx.read() for _ in range(10)]
samples_y = [vry.read() for _ in range(10)]
center_x = sum(samples_x) // 10
center_y = sum(samples_y) // 10
print("Center:", center_x, center_y)
# Then set DEAD_LOW and DEAD_HIGH around those values.

def normalize(value):
    """0..4095  →  -100..+100, with a dead zone around the center."""
    if DEAD_LOW <= value <= DEAD_HIGH:
        return 0
    if value < DEAD_LOW:
        return -((DEAD_LOW - value) * 100) // DEAD_LOW
    return ((value - DEAD_HIGH) * 100) // (4095 - DEAD_HIGH)

while True:
    nx = normalize(vrx.read())
    ny = normalize(vry.read())
    print(f"X={nx:+4d}  Y={ny:+4d}")
    time.sleep_ms(100)