Print status registers on boot

include/serial.h

  */
 uint8_t serialTxBufferEmpty(uint8_t uart);
 
+void serialWriteHex(uint8_t uart, uint8_t value);
+
 #endif // _serial_h
 /** @} */

src/rx.c

 
     cc2500Strobe(CC2500_SIDLE); // Go to idle...
 
+#ifdef DEBUG
+    uint8_t part = cc2500ReadReg(CC2500_30_PARTNUM);
+    uint8_t version = cc2500ReadReg(CC2500_31_VERSION);
+
+    serialWriteString(0, "CC2500 Part Number: 0x");
+    serialWriteHex(0, part);
+    serialWriteString(0, "\nCC2500 Version: 0x");
+    serialWriteHex(0, version);
+    serialWriteString(0, "\n");
+#endif
+
     // hack: Append status, filter by address, auto-flush on bad crc, PQT=0
     cc2500WriteReg(CC2500_07_PKTCTRL1, 0x0D);
 

src/serial.c

     }
 }
 
+void serialWriteHex(uint8_t uart, uint8_t value) {
+    char buff[3] = { 0, 0, '\0' };
+
+    if (value >= 16) {
+        buff[0] = value / 16;
+        value = value % 16;
+    }
+    buff[1] = value;
+
+    if ((buff[0] >= 0) && (buff[0] <= 9)) {
+        buff[0] += '0';
+    } else {
+        buff[0] -= 10;
+        buff[0] += 'A';
+    }
+
+    if ((buff[1] >= 0) && (buff[1] <= 9)) {
+        buff[1] += '0';
+    } else {
+        buff[1] -= 10;
+        buff[1] += 'A';
+    }
+
+    serialWriteString(uart, buff);
+}
+
 uint8_t serialTxBufferFull(uint8_t uart) {
     if (uart >= UART_COUNT)
         return 0;