X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=src%2Fao_monitor.c;h=e5e9159f0bcc4cce71c75d4e210e8d330e52dd93;hb=b51e5466f7a125db873edd1fa9bd3881d7e98aad;hp=ac1929db1aea5ee2563ff5bb295fe53868970069;hpb=489a68ba8e3bc360e2e8fc887e4c4b840b5a0dd3;p=fw%2Faltos

diff --git a/src/ao_monitor.c b/src/ao_monitor.c
index ac1929db..e5e9159f 100644
--- a/src/ao_monitor.c
+++ b/src/ao_monitor.c
@@ -36,6 +36,7 @@ ao_monitor(void)
 #define recv_tiny	(u.tiny)
 
 	uint8_t state;
+	uint8_t sum, byte;
 	int16_t rssi;
 
 	for (;;) {
@@ -189,11 +190,16 @@ ao_monitor(void)
 		default:
 			if (ao_monitoring > AO_MAX_TELEMETRY)
 				ao_monitoring = AO_MAX_TELEMETRY;
-			if (!ao_radio_recv(&recv_raw, ao_monitoring))
+			if (!ao_radio_recv(&recv_raw, ao_monitoring + 2))
 				continue;
-			for (state = 0; state < ao_monitoring + 1; state++)
-				printf("%02x ", recv_raw.packet[state]);
-			printf("%02x\n", recv_raw.packet[state]);
+			printf ("TELEM %02x", ao_monitoring + 2);
+			sum = 0x5a;
+			for (state = 0; state < ao_monitoring + 2; state++) {
+				byte = recv_raw.packet[state];
+				sum += byte;
+				printf("%02x", byte);
+			}
+			printf("%02x\n", sum);
 			break;
 		}
 		ao_usb_flush();