diff --git a/main/xvprintf.c b/main/xvprintf.c
index 31ba327..3087883 100644
--- a/main/xvprintf.c
+++ b/main/xvprintf.c
@@ -15,10 +15,9 @@ void init_tx_ringbuf() {
 // This function will be called by the ESP log library every time ESP_LOG needs to be performed.
 //      @important Do NOT use the ESP_LOG* macro's in this function ELSE recursive loop and stack overflow! So use printf() instead for debug messages.
 int xvprintf(const char *fmt, va_list args) {
-    char msg_to_send[500];
+    char msg_to_send[200];
     size_t str_len;
-    str_len = snprintf(msg_to_send, 499, fmt, va_arg(args, int), va_arg(args, char *));
-    va_end(args);
+    str_len = vsnprintf(msg_to_send, 199, fmt, args);
     xRingbufferSend(can_messages, msg_to_send, str_len + 1, pdMS_TO_TICKS(100));
     return str_len;
 }