refactor: added debug feature

Author: rsny430

src/drivers/OLEDDriver.cpp

@@ -11,7 +11,7 @@ OLEDDriver::OLEDDriver() : display(Config::OLED::WIDTH, Config::OLED::HEIGHT, &W
 
 bool OLEDDriver::begin() {
     if (!display.begin(SSD1306_SWITCHCAPVCC, Config::OLED::ADDRESS)) {
-        Logger::logln("SSD1306 allocation failed");
+        LOG_ERROR("SSD1306 allocation failed");
         return false;
     }
 

src/system/CycleComputer.cpp

@@ -71,10 +71,7 @@ void CycleComputer::logDebugInfo(Mode currentMode, const char* value) {
 
     int modeInt = (int)currentMode;
     if (lastDebugMode != modeInt) {
-        Logger::log("[CycleComputer] Mode changed: ");
-        Logger::log(modeInt);
-        Logger::log(" Value: ");
-        Logger::logln(value);
+        LOG_DEBUG("[CycleComputer] Mode changed: %d Value: %s", modeInt, value);
         lastDebugMode = modeInt;
     }
 #endif

src/system/InputManager.cpp

@@ -15,17 +15,17 @@ InputEvent InputManager::update() {
     bool bPressed = btnB.isPressed();
 
     if ((aPressed && btnB.isHeld()) || (bPressed && btnA.isHeld())) {
-        Logger::logln("[InputManager] 同時に押された");
+        LOG_DEBUG("[InputManager] 同時に押された");
         return InputEvent::BTN_BOTH;
     }
 
     if (aPressed) {
-        Logger::logln("[InputManager] Aボタンが押された");
+        LOG_DEBUG("[InputManager] Aボタンが押された");
         return InputEvent::BTN_A;
     }
 
     if (bPressed) {
-        Logger::logln("[InputManager] Bボタンが押された");
+        LOG_DEBUG("[InputManager] Bボタンが押された");
         return InputEvent::BTN_B;
     }
 

src/system/Logger.cpp

@@ -0,0 +1,72 @@
+#include "Logger.h"
+
+#include <cstdarg>
+#include <cstdio>
+#include <cstring>
+
+#ifdef DEBUG_MODE
+LogLevel currentLogLevel = LogLevel::INFO;
+#else
+LogLevel currentLogLevel = LogLevel::NONE;
+#endif
+
+#ifdef DEBUG_MODE
+void Logger::log(LogLevel level, const char* file, int line, const char* func, const char* fmt, ...) {
+    if (level < currentLogLevel) return;
+
+    char buf[256];
+    va_list args;
+    va_start(args, fmt);
+    vsnprintf(buf, sizeof(buf), fmt, args);
+    va_end(args);
+
+    const char* levelStr = "";
+    switch (level) {
+        case LogLevel::DEBUG:
+            levelStr = "DEBUG";
+            break;
+        case LogLevel::INFO:
+            levelStr = "INFO";
+            break;
+        case LogLevel::WARN:
+            levelStr = "WARN";
+            break;
+        case LogLevel::ERROR:
+            levelStr = "ERROR";
+            break;
+        default:
+            break;
+    }
+
+    // Timestamp
+    unsigned long t = millis();
+    unsigned long h = t / 3600000;
+    t %= 3600000;
+    unsigned long m = t / 60000;
+    t %= 60000;
+    unsigned long s = t / 1000;
+    unsigned long ms = t % 1000;
+
+    char timestamp[32];
+    snprintf(timestamp, sizeof(timestamp), "[%02lu:%02lu:%02lu.%03lu]", h, m, s, ms);
+
+    // File name (basename)
+    const char* filename = strrchr(file, '/');
+    if (filename)
+        filename++;
+    else
+        filename = file;
+
+    Serial.print(timestamp);
+    Serial.print(" [");
+    Serial.print(levelStr);
+    Serial.print("] ");
+    Serial.print(filename);
+    Serial.print(":");
+    Serial.print(line);
+    Serial.print(" (");
+    Serial.print(func);
+    Serial.print("): ");
+    Serial.println(buf);
+}
+#endif

src/system/Logger.h

@@ -4,19 +4,33 @@
 
 #include "../Config.h"
 
+enum class LogLevel {
+    DEBUG,
+    INFO,
+    WARN,
+    ERROR,
+    NONE
+};
+
+extern LogLevel currentLogLevel;
+
 class Logger {
    public:
-    template <typename T>
-    static void log(const T& msg) {
-#ifdef DEBUG_MODE
-        Serial.print(msg);
-#endif
+    static void setLogLevel(LogLevel level) {
+        currentLogLevel = level;
     }
 
-    template <typename T>
-    static void logln(const T& msg) {
+    static void log(LogLevel level, const char* file, int line, const char* func, const char* fmt, ...) __attribute__((format(printf, 5, 6)));
+};
+
 #ifdef DEBUG_MODE
-        Serial.println(msg);
+    #define LOG_DEBUG(fmt, ...) Logger::log(LogLevel::DEBUG, __FILE__, __LINE__, __func__, fmt, ##__VA_ARGS__)
+    #define LOG_INFO(fmt, ...)  Logger::log(LogLevel::INFO,  __FILE__, __LINE__, __func__, fmt, ##__VA_ARGS__)
+    #define LOG_WARN(fmt, ...)  Logger::log(LogLevel::WARN,  __FILE__, __LINE__, __func__, fmt, ##__VA_ARGS__)
+    #define LOG_ERROR(fmt, ...) Logger::log(LogLevel::ERROR, __FILE__, __LINE__, __func__, fmt, ##__VA_ARGS__)
+#else
+    #define LOG_DEBUG(fmt, ...) ((void)0)
+    #define LOG_INFO(fmt, ...)  ((void)0)
+    #define LOG_WARN(fmt, ...)  ((void)0)
+    #define LOG_ERROR(fmt, ...) ((void)0)
 #endif
-    }
-};