Modify masterMain.c and tlvReceiveFsm in SerialInterrupt.c