Fbisinger
diff --git a/‎src/ArduinoOcpp/Debug.h‎
Lines changed: 13 additions & 2 deletions b/‎src/ArduinoOcpp/Debug.h‎
Lines changed: 13 additions & 2 deletions
diff --git a/‎src/ArduinoOcpp/Platform.cpp‎
Lines changed: 24 additions & 0 deletions b/‎src/ArduinoOcpp/Platform.cpp‎
Lines changed: 24 additions & 0 deletions
diff --git a/‎src/ArduinoOcpp/Platform.h‎
Lines changed: 30 additions & 0 deletions b/‎src/ArduinoOcpp/Platform.h‎
Lines changed: 30 additions & 0 deletions
@@ -56,8 +56,19 @@
 #endif
 
 #ifdef AO_TRAFFIC_OUT
-#define AO_DBG_TRAFFIC_OUT(...)  AO_CONSOLE_PRINTF("[AO] To WS lib: %s\n",__VA_ARGS__)
-#define AO_DBG_TRAFFIC_IN(...)  AO_CONSOLE_PRINTF("[AO] From WS lib: %s\n",__VA_ARGS__)
+
+#define AO_DBG_TRAFFIC_OUT(...)   \
+    do {                        \
+        AO_CONSOLE_PRINTF("[AO] To WS lib: %s",__VA_ARGS__);           \
+        AO_CONSOLE_PRINTF("\n");         \
+    } while (0)
+
+#define AO_DBG_TRAFFIC_IN(...)   \
+    do {                        \
+        AO_CONSOLE_PRINTF("[AO] From WS lib: %s",__VA_ARGS__);           \
+        AO_CONSOLE_PRINTF("\n");         \
+    } while (0)
+
 #else
 #define AO_DBG_TRAFFIC_OUT(...)
 #define AO_DBG_TRAFFIC_IN(...)
 
@@ -0,0 +1,24 @@
+// matth-x/ArduinoOcpp
+// Copyright Matthias Akstaller 2019 - 2022
+// MIT License
+
+#include <ArduinoOcpp/Platform.h>
+
+#ifdef AO_CUSTOM_CONSOLE
+
+namespace ArduinoOcpp {
+void (*ao_console_out_impl)(const char *msg) = nullptr;
+}
+
+void ArduinoOcpp::ao_console_out(const char *msg) {
+    if (ao_console_out_impl) {
+        ao_console_out_impl(msg);
+    }
+}
+
+void ao_set_console_out(void (*console_out)(const char *msg)) {
+    ArduinoOcpp::ao_console_out_impl = console_out;
+    console_out("[AO] console initialized\n");
+}
+
+#endif
@@ -5,6 +5,36 @@
 #ifndef AO_PLATFORM_H
 #define AO_PLATFORM_H
 
+#ifdef AO_CUSTOM_CONSOLE
+
+#ifndef AO_CUSTOM_CONSOLE_MAXMSGSIZE
+#define AO_CUSTOM_CONSOLE_MAXMSGSIZE 128
+#endif
+
+void ao_set_console_out(void (*console_out)(const char *msg));
+
+namespace ArduinoOcpp {
+void ao_console_out(const char *msg);
+}
+#define AO_CONSOLE_PRINTF(X, ...) \
+            do { \
+                char msg [AO_CUSTOM_CONSOLE_MAXMSGSIZE]; \
+                snprintf(msg, AO_CUSTOM_CONSOLE_MAXMSGSIZE, X, ##__VA_ARGS__); \
+                sprintf(msg + AO_CUSTOM_CONSOLE_MAXMSGSIZE - 7, " [...]"); \
+                ao_console_out(msg); \
+            } while (0)
+#else
+#define ao_set_console_out(X) \
+            do { \
+                X("[AO] CONSOLE ERROR: ao_set_console_out ignored if AO_CUSTOM_CONSOLE " \
+                  "not defined\n"); \
+                char msg [100]; \
+                snprintf(msg, 100, "     > see %s:%i",__FILE__,__LINE__); \
+                X(msg); \
+                X("\n     > see ArduinoOcpp/Platform.h\n"); \
+            } while (0)
+#endif
+
 #ifndef AO_CONSOLE_PRINTF
 //begin with Arduino support, add more later
 #include <Arduino.h>