From ab606b7eeae20395479ef963807245cb596a0873 Mon Sep 17 00:00:00 2001
From: Armel FAUVEAU <armel.fauveau@globalis-ms.com>
Date: Sat, 24 Feb 2024 05:34:21 +0100
Subject: [PATCH] Improve memory usage

---
 driver/st7565.c | 54 ++++++++++++++++++++++++-------------------------
 driver/st7565.h |  1 -
 2 files changed, 27 insertions(+), 28 deletions(-)

diff --git a/driver/st7565.c b/driver/st7565.c
index 9772a12..d3680fb 100644
--- a/driver/st7565.c
+++ b/driver/st7565.c
@@ -146,6 +146,33 @@ uint8_t cmds[] = {
 	ST7565_CMD_DISPLAY_ON_OFF | 1,			// Display ON/OFF: ON
 };
 
+#ifdef ENABLE_FEAT_F4HWN
+	static void ST7565_Cmd(uint8_t i)
+	{
+		switch(i) {
+			case 3:
+				ST7565_WriteByte(ST7565_CMD_INVERSE_DISPLAY | gSetting_set_inv);
+				break;
+			case 7:
+				ST7565_WriteByte(21 + gSetting_set_ctr);
+				break;
+			default:
+				ST7565_WriteByte(cmds[i]);
+		}
+	}
+
+	void ST7565_ContrastAndInv(void)
+	{
+		SPI_ToggleMasterMode(&SPI0->CR, false);
+		ST7565_WriteByte(ST7565_CMD_SOFTWARE_RESET);   // software reset
+
+		for(uint8_t i = 0; i < 8; i++)
+		{
+			ST7565_Cmd(i);
+		}
+	}
+#endif
+	
 void ST7565_Init(void)
 {
 	SPI0_Init();
@@ -181,33 +208,6 @@ void ST7565_Init(void)
 	ST7565_FillScreen(0x00);
 }
 
-#ifdef ENABLE_FEAT_F4HWN
-	void ST7565_Cmd(uint8_t i)
-	{
-		switch(i) {
-			case 3:
-				ST7565_WriteByte(ST7565_CMD_INVERSE_DISPLAY | gSetting_set_inv);
-				break;
-			case 7:
-				ST7565_WriteByte(21 + gSetting_set_ctr);
-				break;
-			default:
-				ST7565_WriteByte(cmds[i]);
-		}
-	}
-
-	void ST7565_ContrastAndInv(void)
-	{
-		SPI_ToggleMasterMode(&SPI0->CR, false);
-		ST7565_WriteByte(ST7565_CMD_SOFTWARE_RESET);   // software reset
-
-		for(uint8_t i = 0; i < 8; i++)
-		{
-			ST7565_Cmd(i);
-		}
-	}
-#endif
-
 void ST7565_FixInterfGlitch(void)
 {
 	SPI_ToggleMasterMode(&SPI0->CR, false);
diff --git a/driver/st7565.h b/driver/st7565.h
index 3978e10..b5ec79c 100644
--- a/driver/st7565.h
+++ b/driver/st7565.h
@@ -40,7 +40,6 @@ void ST7565_WriteByte(uint8_t Value);
 
 #ifdef ENABLE_FEAT_F4HWN
 	void ST7565_ContrastAndInv(void);
-	void ST7565_Cmd(uint8_t);
 #endif
 
 #endif