Refactor cleanup

debugging.h

@@ -2,6 +2,7 @@
 #define DEBUGGING_H
 
 #include "driver/uart.h"
+#include "driver/bk4819.h"
 #include "string.h"
 #include "external/printf/printf.h"
 
@@ -11,6 +12,13 @@ static inline void LogUart(char * str)
     UART_Send(str, strlen(str));
 }
 
+static inline void LogRegUart(uint16_t reg)
+{
+    uint16_t regVal = BK4819_ReadRegister(reg);
+    char buf[32];
+    sprintf(buf, "reg%02X: %04X\n", reg, regVal);
+    LogUart(buf);
+}