from machine import ADC, Pin, Timer

a2d2 = machine.ADC(2)
tim = Timer()

flag = 0
k = 3.3 / 65520
x0 = x1 = x2 = y0 = y1 = y2 = 0

def tick(timer):
    global flag
    flag = 1
        
tim.init(freq=100, mode=Timer.PERIODIC, callback=tick)

LED = Pin(16,Pin.OUT)


while(1):
    LCD.value(0)
    while(flag == 0):
        pass
    LED1.value(1)
    flag = 0

    a2 = a2d2.read_u16()
    V2 = k*a2
    
    x2 = x1
    x1 = x0
    x0 = k*a2
    
    y2 = y1
    y1 = y0
    y0 = 1.9008*y1 - 0.90483*y0 + 0.001209*(x0 + 2*x1 + x2);
    
    print('{: 7.4f}'.format(x0), '{: 7.4f}'.format(y0))