- printf ("Received data:");
- for (i = 0; i < rx_data_cur; i++) {
- if ((i & 15) == 0)
- printf ("\n");
- printf (" %02x", rx_data[i]);
- }
- printf ("\n");
+ /* Construct final packet */
+
+ ao_fec_decode(rx_data, rx_data_cur, d, size + 2);
+
+ if (ao_fec_check_crc(d, size))
+ ((uint8_t *) d)[size + 1] = 0x80;
+ else
+ ((uint8_t *) d)[size + 1] = 0x00;
+
+ ((uint8_t *) d)[size] = (uint8_t) rssi;
+