From 0d5deffa587345edf99c9bf1c5908f5a4f6b8722 Mon Sep 17 00:00:00 2001
From: Steins7 <steinsset@gmail.com>
Date: Sun, 7 Apr 2024 16:47:34 +0200
Subject: [PATCH] Update debug service to use new dma_mbuf

---
 srv/debug.c | 81 +++++++++++++++++++++++++++++++++++++++++------------
 srv/debug.h |  3 +-
 2 files changed, 64 insertions(+), 20 deletions(-)

diff --git a/srv/debug.c b/srv/debug.c
index 44711ac..2937fe5 100644
--- a/srv/debug.c
+++ b/srv/debug.c
@@ -8,20 +8,20 @@
 //--includes--------------------------------------------------------------------
 
 #include "debug.h"
+#include "dma_mbuf.h"
 
 
 //--local definitions-----------------------------------------------------------
 
-#define BUFFER_SIZE 83  //80 char line + \n + 2 bytes for index
-#define BUFFER_NB    3  //1 buffer in write, one in transfer and one waiting
+static void print_debug(char* str);
+
+#define BUFFER_SIZE 162  //(80 char line + \n) * 2
+
 
 //--local variables-------------------------------------------------------------
 
-static enum UsartPeriph usart_periph;
-static uint8_t tx_buffer1[BUFFER_SIZE];
-static uint8_t tx_buffer2[BUFFER_SIZE];
-static uint8_t tx_buffer3[BUFFER_SIZE];
-static uint8_t* tx_buffers[BUFFER_NB] = {tx_buffer1, tx_buffer2, tx_buffer3};
+static struct DmaMultiBuffer mbuf;
+static uint8_t tx_buffer[BUFFER_SIZE];
 
 
 //--public functions------------------------------------------------------------
@@ -31,30 +31,75 @@ static uint8_t* tx_buffers[BUFFER_NB] = {tx_buffer1, tx_buffer2, tx_buffer3};
 void _debug_init(enum UsartPeriph usart, enum GpioPort tx_port,
 		enum GpioPin tx_pin)
 {
-	usart_periph = usart;
 	gpio_configure(tx_port, tx_pin, GPIO_MODE_OUTPUT_FAST,
 			GPIO_CONFIG_OUT_ALT_PUSH_PULL);
-	usart_configure(usart_periph, USART_CONFIG_8N1, 1152000);
-
-	usart_set_tx_buffer(USART_PERIPH_3, tx_buffers, BUFFER_SIZE, BUFFER_NB,
-			DMA_CONFIG_PRIO_LOW);
+	usart_configure(usart, USART_CONFIG_8N1, 1000000);
+	dma_mbuf_configure(&mbuf,usart_configure_tx_dma(usart),
+			DMA_CONFIG_PRIO_LOW, tx_buffer, BUFFER_SIZE);
 
 	debug_trace("\n");
-	debug_trace("--------------------------------------------------------------------------------\n");
+	debug_trace("------------------------------------------------------------------------------\n");
 	debug_trace("starting debug software\n");
 	debug_trace("compiled on " __DATE__ " at " __TIME__ "\n");
-	debug_trace("--------------------------------------------------------------------------------\n");
+	debug_trace("------------------------------------------------------------------------------\n");
 }
 
+#endif
+
+#if DEBUG_TRACE
+
 void _debug_trace(char* format, ...)
 {
-	while(*format != '\0') {
-		while(usart_write_byte(usart_periph, *format)) {}
-		++format;
-	}
+	print_debug("T:");
+	print_debug(format);
+
+	//ensure everything is written when done
+	while (dma_mbuf_switch(&mbuf)) {}
+}
+
+#endif
+
+#if DEBUG_WARN
+
+void _debug_warn(char* format, ...)
+{
+	print_debug("W:");
+	print_debug(format);
+
+	//ensure everything is written when done
+	while (dma_mbuf_switch(&mbuf)) {}
+}
+
+#endif
+
+#if DEBUG_ERROR
+
+void _debug_error(char* format, ...)
+{
+	print_debug("E:");
+	print_debug(format);
+
+	//ensure everything is written when done
+	while (dma_mbuf_switch(&mbuf)) {}
 }
 
 #endif
 
 //--local functions-------------------------------------------------------------
 
+#if DEBUG_TRACE || DEBUG_WARN || DEBUG_ERROR
+
+static void print_debug(char* str)
+{
+	while (*str != '\0') {
+		if (dma_mbuf_write_byte(&mbuf, *str))
+		{
+			//buffer is full, wait until transfer started
+			while (dma_mbuf_switch(&mbuf)) {}
+		}
+		++str;
+	}
+}
+
+#endif
+
diff --git a/srv/debug.h b/srv/debug.h
index cd511d6..b954511 100644
--- a/srv/debug.h
+++ b/srv/debug.h
@@ -13,12 +13,11 @@
 #include "../drv/usart.h"
 #include "../drv/gpio.h"
 
-#include "stdint.h"
-
 #define DEBUG_TRACE 1
 #define DEBUG_WARN 0
 #define DEBUG_ERROR 0
 
+
 //--type definitions------------------------------------------------------------
 
 #if DEBUG_TRACE || DEBUG_WARN || DEBUG_ERROR