From 9efe6a7ad6e82cd7b2490ff43910d01a0dc73386 Mon Sep 17 00:00:00 2001
From: bkleiner <b.kleiner@str8labs.com>
Date: Sun, 28 Jan 2024 05:47:57 +0100
Subject: [PATCH] stm32: manually init gpio pins to avoid loop in LL

---
 src/driver/stm32/gpio.c | 42 ++++++++++++++++++++++++++---------------
 1 file changed, 27 insertions(+), 15 deletions(-)

diff --git a/src/driver/stm32/gpio.c b/src/driver/stm32/gpio.c
index 669729d50..3ac97d389 100644
--- a/src/driver/stm32/gpio.c
+++ b/src/driver/stm32/gpio.c
@@ -63,24 +63,36 @@ void gpio_ports_init() {
 }
 
 void gpio_pin_init(gpio_pins_t pin, gpio_config_t config) {
-  LL_GPIO_InitTypeDef init;
-  init.Mode = mode_map[config.mode];
-  init.Speed = speed_map[config.drive];
-  init.OutputType = output_map[config.output];
-  init.Pull = pull_map[config.pull];
-  init.Pin = gpio_pin_defs[pin].pin;
-  LL_GPIO_Init(gpio_pin_defs[pin].port, &init);
+  gpio_port_t *port = gpio_pin_defs[pin].port;
+  const uint32_t pin_mask = gpio_pin_defs[pin].pin;
+
+  if ((config.mode == GPIO_OUTPUT) || (config.mode == GPIO_ALTERNATE)) {
+    LL_GPIO_SetPinSpeed(port, pin_mask, speed_map[config.drive]);
+    LL_GPIO_SetPinOutputType(port, pin_mask, output_map[config.output]);
+  }
+  LL_GPIO_SetPinPull(port, pin_mask, pull_map[config.pull]);
+  LL_GPIO_SetPinMode(port, pin_mask, mode_map[config.mode]);
 }
 
 void gpio_pin_init_af(gpio_pins_t pin, gpio_config_t config, uint8_t af) {
-  LL_GPIO_InitTypeDef init;
-  init.Mode = mode_map[config.mode];
-  init.Speed = speed_map[config.drive];
-  init.OutputType = output_map[config.output];
-  init.Pull = pull_map[config.pull];
-  init.Pin = gpio_pin_defs[pin].pin;
-  init.Alternate = af;
-  LL_GPIO_Init(gpio_pin_defs[pin].port, &init);
+  gpio_port_t *port = gpio_pin_defs[pin].port;
+  const uint32_t pin_mask = gpio_pin_defs[pin].pin;
+
+  if ((config.mode == GPIO_OUTPUT) || (config.mode == GPIO_ALTERNATE)) {
+    LL_GPIO_SetPinSpeed(port, pin_mask, speed_map[config.drive]);
+    LL_GPIO_SetPinOutputType(port, pin_mask, output_map[config.output]);
+  }
+  LL_GPIO_SetPinPull(port, pin_mask, pull_map[config.pull]);
+
+  if (config.mode == GPIO_ALTERNATE) {
+    if (POSITION_VAL(pin_mask) < 0x00000008U) {
+      LL_GPIO_SetAFPin_0_7(port, pin_mask, af);
+    } else {
+      LL_GPIO_SetAFPin_8_15(port, pin_mask, af);
+    }
+  }
+
+  LL_GPIO_SetPinMode(port, pin_mask, mode_map[config.mode]);
 }
 
 #define GPIO_AF(pin, af, tag)