Map LL GPIO pin definition to STM_PIN

For F1 LL_GPIO_PIN_X is not the same than GPIO_PIN_X

Signed-off-by: Frederic.Pillon <[email protected]>

Author: fpistm

cores/arduino/stm32/digital_io.h

@@ -39,6 +39,7 @@
 /* Includes ------------------------------------------------------------------*/
 #include "wiring_constants.h"
 #include "PinNames.h"
+#include "pinmap.h"
 #include "stm32yyxx_ll_gpio.h"
 
 #ifdef __cplusplus
@@ -94,7 +95,7 @@ static inline void digital_io_toggle(GPIO_TypeDef *port, uint32_t pin)
   */
 static inline void digitalWriteFast(PinName pn, uint32_t ulVal)
 {
-  digital_io_write(get_GPIO_Port(STM_PORT(pn)), STM_GPIO_PIN(pn), ulVal);
+  digital_io_write(get_GPIO_Port(STM_PORT(pn)), STM_LL_GPIO_PIN(pn), ulVal);
 }
 
 /**
@@ -105,7 +106,7 @@ static inline void digitalWriteFast(PinName pn, uint32_t ulVal)
 static inline int digitalReadFast(PinName pn)
 {
   uint8_t level = 0;
-  level = digital_io_read(get_GPIO_Port(STM_PORT(pn)), STM_GPIO_PIN(pn));
+  level = digital_io_read(get_GPIO_Port(STM_PORT(pn)), STM_LL_GPIO_PIN(pn));
   return (level) ? HIGH : LOW;
 }
 
@@ -117,7 +118,7 @@ static inline int digitalReadFast(PinName pn)
   */
 static inline void digitalToggleFast(PinName pn)
 {
-  digital_io_toggle(get_GPIO_Port(STM_PORT(pn)), STM_GPIO_PIN(pn));
+  digital_io_toggle(get_GPIO_Port(STM_PORT(pn)), STM_LL_GPIO_PIN(pn));
 }
 
 #ifdef __cplusplus

cores/arduino/stm32/pinmap.c

@@ -16,6 +16,27 @@
 //Based on mbed-os/hal/mbed_pinmap_common.c
 
 #include "pinmap.h"
+#include "stm32yyxx_ll_gpio.h"
+
+/* Map STM_PIN to LL */
+const uint32_t pin_map_ll[16] = {
+    LL_GPIO_PIN_0,
+    LL_GPIO_PIN_1,
+    LL_GPIO_PIN_2,
+    LL_GPIO_PIN_3,
+    LL_GPIO_PIN_4,
+    LL_GPIO_PIN_5,
+    LL_GPIO_PIN_6,
+    LL_GPIO_PIN_7,
+    LL_GPIO_PIN_8,
+    LL_GPIO_PIN_9,
+    LL_GPIO_PIN_10,
+    LL_GPIO_PIN_11,
+    LL_GPIO_PIN_12,
+    LL_GPIO_PIN_13,
+    LL_GPIO_PIN_14,
+    LL_GPIO_PIN_15
+};
 
 void* pinmap_find_peripheral(PinName pin, const PinMap* map) {
   while (map->pin != NC) {

cores/arduino/stm32/pinmap.h

@@ -27,6 +27,10 @@
 extern "C" {
 #endif
 
+extern const uint32_t pin_map_ll[16];
+
+#define STM_LL_GPIO_PIN(X) (pin_map_ll[STM_PIN(X)])
+
 // No peripheral
 #define NP       0U