# Joystick Position

import LCD

from machine import ADC
from time import sleep_ms

a2d0 = machine.ADC(0)
a2d1 = machine.ADC(1)

Navy = LCD.RGB(0,0,10)
Yellow = LCD.RGB(150,150,0)
Grey = LCD.RGB(50,50,50)

LCD.Init()
LCD.Clear(Navy)

k = 300 / 65535
x0 = a2d0.read_u16()
y0 = a2d1.read_u16()
x = 0
y = 0
while(1):
    a0 = a2d0.read_u16()
    a1 = a2d1.read_u16()
    LCD.Box(240,160,240+x,165,Navy)
    LCD.Box(240,160,245,160+y,Navy)
    x = int((a0 - x0)*k)
    y = -int((a1 - y0)*k)
    LCD.Box(240,160,240+x,165,Yellow)
    LCD.Box(240,160,245,160+y,Yellow)
    sleep_ms(20)