@@ -95,33 +95,34 @@ void serial1_sendString(const char* stri
stringPtr++;
}
void serial_sendCommand( char moduleID, char sensorID, char* data )
{
char checkSum = 0x00; //initialize checksum
serial0_sendChar('['); //bracket indicates start of command
serial0_sendChar(moduleID);
checkSum+=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()
@@ -128,68 +128,83 @@ int serparser_parse(void)
// Get payload type ID
else if(parserState == STATE_GETDATATYPE)
#ifdef DEBUG
serial0_sendString("type ok\r\n");
#endif
receivedDataType = byte; // Store the type of data receiving
checksumCalc += byte;
setParserState(STATE_GETDATA);
// Get payload data
else if(parserState == STATE_GETDATA)
if (byte == ']') // End of frame
serial0_sendString("eof ok\r\n");
sprintf(buffmeh, "recvd %d bytes data\r\n", dataLength);
serial0_sendString((buffmeh));
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++;
// Data buffer overrun protection
if(dataLength > MAX_PAYLOAD_LEN) {
serial0_sendString("data ovf\r\n");
return PARSERESULT_FAIL;
else {
// Set state. MUST call even though state is maintained to update parse position
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
@@ -7,31 +7,32 @@
* Matthew Kanning
* Kyle Ripperger
* Matthew Kroening
*
*/
#ifndef SERPARSER_H_
#define SERPARSER_H_
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: