import time
from oob_parser import uartParserSDK

parser = uartParserSDK(type ='3D People Counting') #3D People Counting labs (68xx)
frameTime = 50/1000 #50 ms frame time
try:
    uartCom = "COM" + str(19)
    dataCom = "COM" + str(18)
    parser.connectComPorts(uartCom, dataCom)
except Exception as E:
    print(E)
    print('Com port connection failed')
#open config file
fname = 'mmw_pplcount_demo_default.cfg'
cfg_file = open(fname, 'r')
cfg = cfg_file.readlines()
parser.sendCfg(cfg)

while(1):
    print(parser.readAndParseUart())
    time.sleep(float(frameTime))  #50 ms