from machine import Pin, ADC, Timer
from time import sleep
import LCD

flag = 1
T = 0.005
npt = 400

def tick(timer):
    global flag
    flag = 1

Beeper = Pin(13, Pin.OUT)

def Beep():
    Beeper.value(1)
    sleep(0.05)
    Beeper.value(0)
    
   
Time = Timer()
Time.init(freq=1/T, mode=Timer.PERIODIC, callback=tick)

B0 = Pin(15, Pin.IN, Pin.PULL_UP)
B1 = Pin(14, Pin.IN, Pin.PULL_UP)

a2d2 = ADC(2)

Navy = LCD.RGB(0,0,5)
Yellow = LCD.RGB(200,200,0)
White = LCD.RGB(200,200,200)

LCD.Init()
LCD.Clear(Navy)
time = 0


x = [0]*npt
y = [0]*npt

LCD.Init()
k = 200 / 65535

FileName = 'Jump3.txt'

while(0):
    z1 = a2d2.read_u16()
    Az = k * (z1 - 13843) - 3.6
    print(Az)
    sleep(0.1)
    
  
while(1):
    Beep()
    for i in range(0,npt):
        while(flag == 0):
            pass
        flag = 0

        z1 = a2d2.read_u16()
        Az = k * (z1 - 13843) - 3.6
        x[i] = i    
        y[i] = Az

    LCD.Clear(Navy)
    LCD.Plot(x,y)
    LCD.Title(FileName,White, Navy)
    
    while(B0.value() & B1.value()):
        pass
    if(B0.value() == 0):
        print('Writing to File')
        file1 = open(FileName, "w")
        for i in range(0,npt):
            file1.write(str('{: 9.3f}'.format(x[i]*T)))
            file1.write(str('{: 9.4f}'.format(y[i])))
            file1.write("\n")
        file1.close()


    sleep(1)