Binary message payload handling

2014-07-24 13:34:44 +02:00
parent 6aa321cf2e
commit cdf4d6ab52
4 changed files with 61 additions and 3 deletions
@@ -28,6 +28,30 @@ const char* MyMessage::getString() const {
 	}
 }

+// handles single character hex (0 - 15)
+char MyMessage::i2h(uint8_t i) const {
+	uint8_t k = i & 0x0F;
+	if (k <= 9)
+		return '0' + k;
+	else
+		return 'A' + k - 10;
+}
+
+char* MyMessage::getStream(char *buffer) const {
+	uint8_t cmd = miGetCommand();
+	if ((cmd == C_STREAM) && (buffer != NULL)) {
+		for (uint8_t i = 0; i < miGetLength(); i++)
+		{
+			buffer[i * 2] = i2h(data[i] >> 4);
+			buffer[(i * 2) + 1] = i2h(data[i]);
+		}
+		buffer[miGetLength() * 2] = '\0';
+		return buffer;
+	} else {
+		return NULL;
+	}
+}
+
 char* MyMessage::getString(char *buffer) const {
 	uint8_t payloadType = miGetPayloadType();