Add support for callbacks and various other improvements

Printers.cpp

@@ -0,0 +1,356 @@
+#include "Printers.h"
+
+void printHex(Print& p, const uint8_t* buf, size_t len, const __FlashStringHelper* byte_sep, const __FlashStringHelper* group_sep, size_t group_by) {
+	size_t cur_group = 0;
+	while (len--) {
+		// Print the group separator whenever starting a new
+		// group
+		if (group_by && group_sep && cur_group == group_by) {
+			p.print(group_sep);
+			cur_group = 0;
+		}
+
+		// Print the byte separator, except when at the start of
+		// a new group (this also excludes the first byte)
+		if (cur_group != 0 && byte_sep)
+			p.print(byte_sep);
+
+		printHex(p, *buf);
+
+		buf++;
+		cur_group++;
+	}
+}
+
+void printErrorCb(uint8_t code, uintptr_t data) {
+	Print *p = (Print*)data;
+	p->print(F("Error reading API packet. Error code: "));
+	p->println(code);
+}
+
+void printErrorCb(ZBTxStatusResponse& r, uintptr_t data) {
+	Print *p = (Print*)data;
+	if (!r.isSuccess()) {
+		p->print(F("Error sending Zigbee packet. Delivery status: "));
+		p->println(r.getDeliveryStatus());
+	}
+}
+
+void printErrorCb(TxStatusResponse& r, uintptr_t data) {
+	Print *p = (Print*)data;
+	if (!r.isSuccess()) {
+		p->print(F("Error sending packet. Delivery status: "));
+		p->println(r.getStatus());
+	}
+}
+
+void printErrorCb(AtCommandResponse& r, uintptr_t data) {
+	Print *p = (Print*)data;
+	if (!r.isOk()) {
+		p->print(F("Error sending "));
+		p->write(r.getCommand(), 2);
+		p->print(F(" command. Status: "));
+		p->println(r.getStatus());
+	}
+}
+
+void printErrorCb(RemoteAtCommandResponse& r, uintptr_t data) {
+	Print *p = (Print*)data;
+	if (!r.isOk()) {
+		p->print(F("Error sending remote "));
+		p->write(r.getCommand(), 2);
+		p->print(F(" command. Status: "));
+		p->println(r.getStatus());
+	}
+}
+
+void printErrorCb(XBeeResponse& r, uintptr_t data) {
+	uint8_t id = r.getApiId();
+	// Figure out the API type and call the corresonding function
+	if (id == ZB_TX_STATUS_RESPONSE) {
+		ZBTxStatusResponse response;
+		r.getZBTxStatusResponse(response);
+		printErrorCb(response, data);
+	} else if (id == TX_STATUS_RESPONSE) {
+		TxStatusResponse response;
+		r.getTxStatusResponse(response);
+		printErrorCb(response, data);
+	} else if (id == AT_COMMAND_RESPONSE) {
+		AtCommandResponse response;
+		r.getAtCommandResponse(response);
+		printErrorCb(response, data);
+	} else if (id == REMOTE_AT_COMMAND_RESPONSE) {
+		RemoteAtCommandResponse response;
+		r.getRemoteAtCommandResponse(response);
+		printErrorCb(response, data);
+	}
+}
+
+
+
+void printRawResponseCb(XBeeResponse& response, uintptr_t data) {
+	Print *p = (Print*)data;
+	p->print("Response received: ");
+	// Reconstruct the original packet
+	uint8_t header[] = {START_BYTE, response.getMsbLength(), response.getLsbLength(), response.getApiId()};
+	printHex(*p, header, sizeof(header), F(" "), NULL);
+	p->write(' ');
+	printHex(*p, response.getFrameData(), response.getFrameDataLength(), F(" "), NULL);
+	p->println();
+}
+
+
+
+/**
+ * Helper function to print a field name, followed by the hexadecimal
+ * value and a newline.
+ */
+template <typename T>
+static void printField(Print* p, const __FlashStringHelper *prefix, T data) {
+	p->print(prefix);
+	printHex(*p, data);
+	p->println();
+}
+
+void printResponseCb(ZBTxStatusResponse& status, uintptr_t data) {
+	Print *p = (Print*)data;
+	p->println(F("ZBTxStatusResponse received:"));
+	printField(p, F("  FrameId: 0x"), status.getFrameId());
+	printField(p, F("  To: 0x"), status.getRemoteAddress());
+	printField(p, F("  Delivery status: 0x"), status.getDeliveryStatus());
+	printField(p, F("  Discovery status: 0x"), status.getDiscoveryStatus());
+}
+
+void printResponseCb(ZBRxResponse& rx, uintptr_t data) {
+	Print *p = (Print*)data;
+	p->println(F("ZBRxResponse received:"));
+	printField(p, F("  From: 0x"), rx.getRemoteAddress64());
+	printField(p, F("  From: 0x"), rx.getRemoteAddress16());
+	printField(p, F("  Receive options: 0x"), rx.getOption());
+	if (rx.getDataLength() > 8)
+		p->print("  Payload:\r\n    ");
+	else
+		p->print("  Payload: ");
+	printHex(*p, rx.getFrameData() + rx.getDataOffset(), rx.getDataLength(), F(" "), F("\r\n    "), 8);
+	p->println();
+}
+
+void printResponseCb(ZBExplicitRxResponse& rx, uintptr_t data) {
+	Print *p = (Print*)data;
+	p->println(F("ZBExplicitRxResponse received:"));
+	printField(p, F("  From: 0x"), rx.getRemoteAddress64());
+	printField(p, F("  From: 0x"), rx.getRemoteAddress16());
+	printField(p, F("  Receive options: 0x"), rx.getOption());
+	printField(p, F("  Src endpoint: 0x"), rx.getSrcEndpoint());
+	printField(p, F("  Dst endpoint: 0x"), rx.getDstEndpoint());
+	printField(p, F("  Cluster id: 0x"), rx.getClusterId());
+	printField(p, F("  Profile id: 0x"), rx.getProfileId());
+	if (rx.getDataLength() > 8)
+		p->print("  Payload:\r\n    ");
+	else
+		p->print("  Payload: ");
+	printHex(*p, rx.getFrameData() + rx.getDataOffset(), rx.getDataLength(), F(" "), F("\r\n    "), 8);
+	p->println();
+}
+
+void printResponseCb(ZBRxIoSampleResponse& rx, uintptr_t data) {
+	Print *p = (Print*)data;
+	p->println(F("ZBRxIoSampleResponse received:"));
+	printField(p, F("  From: 0x"), rx.getRemoteAddress64());
+	printField(p, F("  From: 0x"), rx.getRemoteAddress16());
+	printField(p, F("  Receive options: 0x"), rx.getOption());
+	for (uint8_t i = 0; i < 16; ++i) {
+		if (rx.isDigitalEnabled(i)) {
+			p->print(F("  Digital pin "));
+			p->print(i);
+			p->print(F(": "));
+			p->print(rx.isDigitalOn(i) ? "HIGH" : "LOW");
+			p->println();
+		}
+	}
+	for (uint8_t i = 0; i < 8; ++i) {
+		if (rx.isAnalogEnabled(i)) {
+			p->print(F("  Analog pin "));
+			p->print(i);
+			p->print(F(": 0x"));
+			printHex(*p, rx.getAnalog(i));
+			p->println();
+		}
+	}
+}
+
+void printResponseCb(TxStatusResponse& status, uintptr_t data) {
+	Print *p = (Print*)data;
+	p->println(F("TxStatusResponse received:"));
+	printField(p, F("  FrameId: 0x"), status.getFrameId());
+	printField(p, F("  Status: 0x"), status.getStatus());
+}
+
+void printResponseCb(Rx16Response& rx, uintptr_t data) {
+	Print *p = (Print*)data;
+	p->println("Rx16Response received:");
+	printField(p, F("  From: 0x"), rx.getRemoteAddress16());
+	printField(p, F("  Rssi: 0x"), rx.getRssi());
+	printField(p, F("  Receive options: 0x"), rx.getOption());
+	if (rx.getDataLength() > 8)
+		p->print("  Payload:\r\n    ");
+	else
+		p->print("  Payload: ");
+	printHex(*p, rx.getFrameData() + rx.getDataOffset(), rx.getDataLength(), F(" "), F("\r\n    "), 8);
+	p->println();
+}
+
+void printResponseCb(Rx64Response& rx, uintptr_t data) {
+	Print *p = (Print*)data;
+	p->println("Rx64Response received:");
+	printField(p, F("  From: 0x"), rx.getRemoteAddress64());
+	printField(p, F("  Rssi: 0x"), rx.getRssi());
+	printField(p, F("  Receive options: 0x"), rx.getOption());
+	if (rx.getDataLength() > 8)
+		p->print("  Payload:\r\n    ");
+	else
+		p->print("  Payload: ");
+	printHex(*p, rx.getFrameData() + rx.getDataOffset(), rx.getDataLength(), F(" "), F("\r\n    "), 8);
+	p->println();
+}
+
+/**
+ * Helper function to share common functionality between the two sample
+ * resonses.
+ */
+static void printSamples(Print* p, RxIoSampleBaseResponse& rx) {
+	for (uint8_t s = 0; s < rx.getSampleSize(); ++s) {
+		p->print(F("  Sample "));
+		p->print(s);
+		p->println(F(":"));
+
+		for (uint8_t i = 0; i < 9; ++i) {
+			if (rx.isDigitalEnabled(i)) {
+				p->print(F("    Digital pin "));
+				p->print(i);
+				p->print(F(": "));
+				p->print(rx.isDigitalOn(i, s) ? "HIGH" : "LOW");
+				p->println();
+			}
+		}
+		for (uint8_t i = 0; i < 7; ++i) {
+			if (rx.isAnalogEnabled(i)) {
+				p->print(F("    Analog pin "));
+				p->print(i);
+				p->print(F(": 0x"));
+				printHex(*p, rx.getAnalog(i, s));
+				p->println();
+			}
+		}
+	}
+}
+
+void printResponseCb(Rx16IoSampleResponse& rx, uintptr_t data) {
+	Print *p = (Print*)data;
+	p->println("Rx16IoSampleResponse received:");
+	printField(p, F("  From: 0x"), rx.getRemoteAddress16());
+	printField(p, F("  Rssi: 0x"), rx.getRssi());
+	printField(p, F("  Receive options: 0x"), rx.getOption());
+	printField(p, F("  Number of samples: 0x"), rx.getSampleSize());
+	printSamples(p, rx);
+}
+
+void printResponseCb(Rx64IoSampleResponse& rx, uintptr_t data) {
+	Print *p = (Print*)data;
+	p->println("Rx64IoSampleResponse received:");
+	printField(p, F("  From: 0x"), rx.getRemoteAddress64());
+	printField(p, F("  Rssi: 0x"), rx.getRssi());
+	printField(p, F("  Receive options: 0x"), rx.getOption());
+	printField(p, F("  Number of samples: 0x"), rx.getSampleSize());
+	printSamples(p, rx);
+}
+
+void printResponseCb(ModemStatusResponse& status, uintptr_t data) {
+	Print *p = (Print*)data;
+	p->println("ModemStatusResponse received:");
+	printField(p, F("  Status: 0x"), status.getStatus());
+}
+
+void printResponseCb(AtCommandResponse& at, uintptr_t data) {
+	Print *p = (Print*)data;
+	p->println("AtCommandResponse received:");
+	p->print(F("  Command: "));
+	p->write(at.getCommand(), 2);
+	p->println();
+	printField(p, F("  Status: 0x"), at.getStatus());
+	if (at.getValueLength()) {
+		p->print(F("  Value: "));
+		printHex(*p, at.getValue(), at.getValueLength(), F(" "), NULL);
+		p->println();
+	}
+}
+
+void printResponseCb(RemoteAtCommandResponse& at, uintptr_t data) {
+	Print *p = (Print*)data;
+	p->println("AtRemoteCommandResponse received:");
+	printField(p, F("  To: 0x"), at.getRemoteAddress64());
+	printField(p, F("  To: 0x"), at.getRemoteAddress16());
+	p->print(F("  Command: "));
+	p->write(at.getCommand(), 2);
+	p->println();
+	printField(p, F("  Status: 0x"), at.getStatus());
+	if (at.getValueLength()) {
+		p->print(F("  Value: "));
+		printHex(*p, at.getValue(), at.getValueLength(), F(" "), NULL);
+		p->println();
+	}
+}
+
+void printResponseCb(XBeeResponse& r, uintptr_t data) {
+	uint8_t id = r.getApiId();
+	// Figure out the API type and call the corresonding function
+	if (id == ZB_TX_STATUS_RESPONSE) {
+		ZBTxStatusResponse response;
+		r.getZBTxStatusResponse(response);
+		printResponseCb(response, data);
+	} else if (id == ZB_RX_RESPONSE) {
+		ZBRxResponse response;
+		r.getZBRxResponse(response);
+		printResponseCb(response, data);
+	} else if (id == ZB_EXPLICIT_RX_RESPONSE) {
+		ZBExplicitRxResponse response;
+		r.getZBExplicitRxResponse(response);
+		printResponseCb(response, data);
+	} else if (id == ZB_IO_SAMPLE_RESPONSE) {
+		ZBRxIoSampleResponse response;
+		r.getZBRxIoSampleResponse(response);
+		printResponseCb(response, data);
+	} else if (id == TX_STATUS_RESPONSE) {
+		TxStatusResponse response;
+		r.getTxStatusResponse(response);
+		printResponseCb(response, data);
+	} else if (id == RX_16_RESPONSE) {
+		Rx16Response response;
+		r.getRx16Response(response);
+		printResponseCb(response, data);
+	} else if (id == RX_64_RESPONSE) {
+		Rx64Response response;
+		r.getRx64Response(response);
+		printResponseCb(response, data);
+	} else if (id == RX_16_IO_RESPONSE) {
+		Rx16IoSampleResponse response;
+		r.getRx16IoSampleResponse(response);
+		printResponseCb(response, data);
+	} else if (id == RX_64_IO_RESPONSE) {
+		Rx64IoSampleResponse response;
+		r.getRx64IoSampleResponse(response);
+		printResponseCb(response, data);
+	} else if (id == MODEM_STATUS_RESPONSE) {
+		ModemStatusResponse response;
+		r.getModemStatusResponse(response);
+		printResponseCb(response, data);
+	} else if (id == AT_COMMAND_RESPONSE) {
+		AtCommandResponse response;
+		r.getAtCommandResponse(response);
+		printResponseCb(response, data);
+	} else if (id == REMOTE_AT_COMMAND_RESPONSE) {
+		RemoteAtCommandResponse response;
+		r.getRemoteAtCommandResponse(response);
+		printResponseCb(response, data);
+	}
+}