import Messages
import time
from ProcessList import processList
from PCANBasic import *
from PCANBasic import TPCANTimestamp, TPCANMsg

PCAN = PCANBasic()  # type: PCANBasic
res = PCAN.Initialize(PCAN_USBBUS1, PCAN_BAUD_500K)
PCAN.FilterMessages(PCAN_USBBUS1, 1979, 1979, PCAN_MESSAGE_STANDARD)

while True:
    print("new")
    v = []
    time.sleep(.005)
    PCAN.Write(PCAN_USBBUS1, Messages.rCellVInit)
    cellMessage = False
    # Keep reading messages until a cell voltage message is received
    while (cellMessage == False):
        print("in loop")
        time.sleep(.016)
        MSG = PCAN.Read(PCAN_USBBUS1)
        MSG = MSG[1]
        print(MSG.ID)
        if MSG.ID == 0x7bb:
            cellMessage = True
    print("out of loop")
    s = "%s%s%s%s" % (MSG.DATA[4], MSG.DATA[5], MSG.DATA[6], MSG.DATA[7])
    v.append(int(s))
    print(v)

    #PCAN.Write(PCAN_USBBUS1, Messages.rCellV)
    for i in range(0, 28):
        print("*************** i = #%s " % i)
        #time.sleep(.016)
        PCAN.Write(PCAN_USBBUS1, Messages.rCellV)
        #print("message sent")
        cellMessage = False
        while (cellMessage == False):
            time.sleep(.001)
            MSG = PCAN.Read(PCAN_USBBUS1)
            MSG = MSG[1]
            if MSG.ID != 0:
                print(MSG.ID)
            time.sleep(.010)
            if MSG.ID == 0x7bb:
                cellMessage = True
                print("true!")
        s = s + "%s%s%s%s%s%s%s" % (MSG.DATA[1], MSG.DATA[2], MSG.DATA[3], MSG.DATA[4], MSG.DATA[5], MSG.DATA[6], MSG.DATA[7])
        v.append(int(s))

    print(v)
    print(len(v))
    #processString(v)