add parser class for serial and ethernet gateways

libraries/MySensors/MyParserSerial.cpp

@@ -0,0 +1,81 @@
+#include "MyParser.h"
+#include "MyParserSerial.h"
+
+MyParserSerial::MyParserSerial() : MyParser() {}
+
+bool MyParserSerial::parse(MyMessage &message, char *inputString) {
+	char *str, *p, *value=NULL;
+	uint8_t bvalue[MAX_PAYLOAD];
+	uint8_t blen = 0;
+	int i = 0;
+	uint8_t command = 0;
+	uint8_t ack = 0;
+
+	// Extract command data coming on serial line
+	for (str = strtok_r(inputString, ";", &p); // split using semicolon
+		str && i < 6; // loop while str is not null an max 5 times
+		str = strtok_r(NULL, ";", &p) // get subsequent tokens
+			) {
+		switch (i) {
+			case 0: // Radioid (destination)
+				message.destination = atoi(str);
+				break;
+			case 1: // Childid
+				message.sensor = atoi(str);
+				break;
+			case 2: // Message type
+				command = atoi(str);
+				mSetCommand(message, command);
+				break;
+			case 3: // Should we request ack from destination?
+				ack = atoi(str);
+				break;
+			case 4: // Data type
+				message.type = atoi(str);
+				break;
+			case 5: // Variable value
+				if (command == C_STREAM) {
+					blen = 0;
+					uint8_t val;
+					while (*str) {
+						val = h2i(*str++) << 4;
+						val += h2i(*str++);
+						bvalue[blen] = val;
+						blen++;
+					}
+				} else {
+					value = str;
+					// Remove ending carriage return character (if it exists)
+					uint8_t lastCharacter = strlen(value)-1;
+					if (value[lastCharacter] == '\r')
+						value[lastCharacter] = 0;
+				}
+				break;
+		}
+		i++;
+	}
+	// Check for invalid input
+	if (i < 5)
+		return false;
+
+	message.sender = GATEWAY_ADDRESS;
+	message.last = GATEWAY_ADDRESS;
+    mSetRequestAck(message, ack?1:0);
+    mSetAck(message, false);
+	if (command == C_STREAM)
+		message.set(bvalue, blen);
+	else
+		message.set(value);
+	return true;
+}
+
+uint8_t MyParserSerial::h2i(char c) {
+	uint8_t i = 0;
+	if (c <= '9')
+		i += c - '0';
+	else if (c >= 'a')
+		i += c - 'a' + 10;
+	else
+		i += c - 'A' + 10;
+	return i;
+}