Add logging functionality

diff --git a/Framing.h b/Framing.h
index d3002d5593b25dc66f6214b3b3e62b25dee3898e..92b0c992b56fad6e360cad71b6d59a927a56676c 100644 (file)
--- a/Framing.h
+++ b/Framing.h
@@ -106,6 +106,14 @@
   #define ERROR_MEMORY_LOW    0x05
   #define ERROR_MODEM_TIMEOUT 0x06
 
+  // Serial logging
+  #define LOG_MSG         0x2F
+
+  #define MSG_INFO        0x01
+  #define MSG_ERR         0x02
+  #define MSG_DBG         0x03
+  #define MSG_TRACE       0x04
+
   // Serial framing variables
   size_t frame_len;
   bool IN_FRAME = false;

diff --git a/Utilities.h b/Utilities.h
index 50a4d1014afbb5e8ee4190015f98faea8a62f248..ba13ed6ab71fb9a3ecacc5b3d2ed1d87ae173c2d 100644 (file)
--- a/Utilities.h
+++ b/Utilities.h
@@ -1712,4 +1712,24 @@ void unlock_rom() {
        eeprom_erase();
 }
 
+void log_debug(const char* msg) {
+    serial_write(FEND);
+    serial_write(LOG_MSG);
+    serial_write(MSG_DBG);
+    for (int i = 0; i < strlen(msg); i++) {
+        escaped_serial_write(msg[i]);
+    }
+    serial_write(FEND);
+}
+
+void log_debug(char* msg) {
+    serial_write(FEND);
+    serial_write(LOG_MSG);
+    serial_write(MSG_DBG);
+    for (int i = 0; i < strlen(msg); i++) {
+        escaped_serial_write(msg[i]);
+    }
+    serial_write(FEND);
+}
+
 #include "src/misc/FIFOBuffer.h"