import matplotlib.pyplot as plt
import numpy as np
from scipy import signal
import time
import serial

from packet_parser_helpers import *
                
def update_with_data(ser, types):
    
    ser.timeout = 3
    ser.reset_input_buffer()
    start = time.time()
    while(True):
        ser.write(b'r')
        size = int.from_bytes(ser.read(4), byteorder = 'little', signed = False)
        cons = ser.read(size)
        read_and_process(types, cons, size)
        
def main():

    ser = serial.Serial(port = '/dev/ttyACM1', timeout = 0.5)
    ser.flush()
    ser.reset_input_buffer()

    ser.write(b'?')
    lines = []
    for i in range(13):
        lines.append(ser.readline().strip(b'\n').strip(b'\r'))
    
    types = get_type_list(lines)

    # ser.write(b'1')
    # ser.write(b'3')
    # ser.write(b'5')
    ser.flush()
    
    update_with_data(ser, types)

main()