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

flag = 1
T = 0.0025

def tick(timer):
    global flag
    flag = 1
    
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)
kV = 3.3 / 65535

Navy = LCD.RGB(0,0,5)
Yellow = LCD.RGB(200,200,0)
LCD.Init()
LCD.Clear(Navy)
time = 0


x = [0]*1000
y = [0]*1000

LCD.Init()

while(1):   
    for i in range(0,1000):
        while(flag == 0):
            pass
        flag = 0
    
        Volts = (a2d2.read_u16() * kV)
        x[i] = i    
        y[i] = Volts

    Navy = LCD.RGB(0,0,5)
    White = LCD.RGB(200,200,200)
    LCD.Clear(Navy)
    LCD.Plot(x,y)
    LCD.Title('Heart Rate',White, Navy)
    
    while(B0.value() & B1.value()):
        pass
    if(B0.value() == 0):
        print('Writing to File')
        file1 = open("HeartRate_2.txt", "w")
        for i in range(0,1000):
            file1.write(str('{: 7.3f}'.format(x[i]*T)))
            file1.write(str('{: 7.4f}'.format(y[i])))
            file1.write("\n")
        file1.close()


    sleep(1)