@@ -107,21 +107,22 @@ void serial_sendCommand( char moduleID,
serial0_sendChar(sensorID);
checkSum+=sensorID;
// send data, null-terminated
while(*data != 0x00)
{
serial0_sendChar(*data);
checkSum += *data;
data++;
}
serial0_sendChar(checkSum);
serial0_sendChar(']'); //bracket indicates end of command
serial0_sendChar(checkSum); // checksum moved behind bracket to solve bug FS#29
void serial_sendResponseData()
@@ -140,37 +140,29 @@ int serparser_parse(void)
// Get payload data
else if(parserState == STATE_GETDATA)
if (byte == ']') // End of frame
#ifdef DEBUG
serial0_sendString("eof ok\r\n");
sprintf(buffmeh, "recvd %d bytes data\r\n", dataLength);
serial0_sendString((buffmeh));
#endif
if(bufferParsePosition == bufferDataPosition)
// We are at the end of the line. No more data to parse.
setParserState(STATE_RESET);
return PARSERESULT_PARSEOK;
else
// we could choose to keep parsing now, or parse the next message next loop around (better idea).
// return now so we hit it the next time around
setParserState(STATE_GETCHECKSUM);
// Checksum is now after the close bracket to solve bug FS#29
else // Still receiving data
serial0_sendString("data ok\r\n");
receivedPayload[dataLength] = byte;
dataLength++;
checksumCalc += byte;
// Data buffer overrun protection
if(dataLength > MAX_PAYLOAD_LEN) {
@@ -180,16 +172,39 @@ int serparser_parse(void)
return PARSERESULT_FAIL;
else {
// Set state. MUST call even though state is maintained to update parse position
setParserState(STATE_GETDATA);
return PARSERESULT_STILLPARSING;
else if(STATE_GETCHECKSUM)
// TODO: Compare checksums
if(byte == checksumCalc) {
serial0_sendString("checksum ok\r\n");
serial0_sendString("checksum fail\r\n");
return PARSERESULT_NODATA;
\ No newline at end of file
@@ -19,19 +19,20 @@ enum parseResults
PARSERESULT_FAIL = 0,
PARSERESULT_NODATA,
PARSERESULT_STILLPARSING,
PARSERESULT_PARSEOK,
};
// Parser states
enum parseStates
STATE_RESET = 0,
STATE_GETID,
STATE_GETDATATYPE,
STATE_GETDATA
STATE_GETDATA,
STATE_GETCHECKSUM,
// Prototypes
int serparser_parse(void);
#endif /* SERPARSER_H_ */
Status change: