Added debugPrint and uartMenu

include/main.h

@@ -0,0 +1,25 @@
+/*
+ * Main / Debug Stuff
+ */
+
+#ifndef _MAIN_H
+#define _MAIN_H
+
+#ifdef DEBUG
+
+#include "serial.h"
+
+#define debugWrite(x) serialWriteString(0, x);
+#define debugHex(x) serialWriteHex(0, x);
+
+void uartMenu(void);
+
+#else // DEBUG
+
+#define debugWrite(x)
+#define debugHex(x)
+
+#endif // DEBUG
+
+#endif
+

src/main.c

@@ -9,10 +9,7 @@
 #include "timer.h"
 #include "cppm.h"
 #include "rx.h"
-
-#ifdef DEBUG
-#include "serial.h"
-#endif
+#include "main.h"
 
 void watchdogBoot(void) __attribute__((naked)) __attribute__((section(".init3")));
 void watchdogBoot(void) {
@@ -20,31 +17,70 @@ void watchdogBoot(void) {
     wdt_disable();
 }
 
+#ifdef DEBUG
+void uartMenu(void) {
+    if (!serialHasChar(0))  {
+        return;
+    }
+
+    uint8_t c = serialGet(0);
+    time_t time = timerGet();
+    switch (c) {
+    case 't': case 'T':
+        debugWrite("Uptime: ");
+        serialWriteUnsigned64(0, time);
+        debugWrite("ms / ");
+        serialWriteUnsigned64(0, time / 1000);
+        debugWrite("s\n");
+        break;
+
+    case 'q': case 'Q':
+        debugWrite("Resetting...\n\n");
+        wdt_enable(WDTO_15MS);
+        for (;;) { }
+        break;
+
+    default:
+        debugWrite("Unknown command: '");
+        serialWrite(0, c);
+        debugWrite("'\n");
+
+    case 'h': case 'H': case '?':
+        debugWrite("Available commands:\n");
+        debugWrite("  h - Help\n");
+        debugWrite("  t - Time\n");
+        debugWrite("  q - Reset\n");
+        break;
+    }
+}
+#endif
+
 void main(void) {
     cppmInit();
     timerInit();
 
 #ifdef DEBUG
-    serialInit(0, BAUD(19200, F_CPU));
+    serialInit(0, BAUD(38400, F_CPU));
 #endif
 
     sei(); // Enable interrupts (required for timer)
-    wdt_enable(WDTO_250MS); // Trigger Watchdog after 250ms
+    //wdt_enable(WDTO_250MS); // Trigger Watchdog after 250ms
+    wdt_enable(WDTO_2S); // Trigger Watchdog after 2s
 
-#ifdef DEBUG
-    serialWriteString(0, "RX reset.\n");
-#endif
+    debugWrite("RX reset.\n");
 
     spiInit();
     rxInit();
 
-#ifdef DEBUG
-    serialWriteString(0, "RX ready!\n");
-#endif
+    debugWrite("RX ready!\n");
 
     for(;;) {
         wdt_reset();
         rxReceivePacket();
+
+#ifdef DEBUG
+        uartMenu();
+#endif
     }
 }