Use LL for GPIO access

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

Author: fpistm

cores/arduino/stm32/digital_io.c

@@ -57,7 +57,11 @@ void digital_io_init(PinName pin, uint32_t mode, uint32_t pull)
   GPIO_InitTypeDef GPIO_InitStructure;
   GPIO_TypeDef *port = set_GPIO_Port_Clock(STM_PORT(pin));
   GPIO_InitStructure.Pin = STM_GPIO_PIN(pin);
+#ifdef GPIO_SPEED_FREQ_VERY_HIGH
+  GPIO_InitStructure.Speed = GPIO_SPEED_FREQ_VERY_HIGH;
+#else
   GPIO_InitStructure.Speed = GPIO_SPEED_FREQ_HIGH;
+#endif
   GPIO_InitStructure.Mode = mode;
   GPIO_InitStructure.Pull = pull;
 #ifdef STM32F1xx
@@ -66,34 +70,6 @@ void digital_io_init(PinName pin, uint32_t mode, uint32_t pull)
   HAL_GPIO_Init(port, &GPIO_InitStructure);
 }
 
-/**
-  * @brief  This function set a value to an IO
-  * @param  port : one of the gpio port
-  * @param  pin : one of the gpio pin
-  * @param  val : 0 to set to low, any other value to set to high
-  * @retval None
-  */
-void digital_io_write(GPIO_TypeDef  *port, uint32_t pin, uint32_t val)
-{
-  if(val) {
-    HAL_GPIO_WritePin(port, pin, GPIO_PIN_SET);
-  } else {
-    HAL_GPIO_WritePin(port, pin, GPIO_PIN_RESET);
-  }
-}
-
-
-/**
-  * @brief  This function set a value to an IO
-  * @param  port : one of the gpio port
-  * @param  pin : one of the gpio pin
-  * @retval The pin state (LOW or HIGH)
-  */
-uint32_t digital_io_read(GPIO_TypeDef  *port, uint32_t pin)
-{
-  return (uint32_t)HAL_GPIO_ReadPin(port, pin);
-}
-
 #ifdef __cplusplus
 }
 #endif

cores/arduino/stm32/digital_io.h

@@ -42,6 +42,7 @@
 /* Includes ------------------------------------------------------------------*/
 #include "stm32_def.h"
 #include "PeripheralPins.h"
+#include "stm32yyxx_ll_gpio.h"
 
 #ifdef __cplusplus
  extern "C" {
@@ -52,8 +53,34 @@
 /* Exported macro ------------------------------------------------------------*/
 /* Exported functions ------------------------------------------------------- */
 void digital_io_init(PinName pin, uint32_t mode, uint32_t pull);
-void digital_io_write(GPIO_TypeDef  *port, uint32_t pin, uint32_t val);
-uint32_t digital_io_read(GPIO_TypeDef  *port, uint32_t pin);
+
+/**
+  * @brief  This function set a value to an IO
+  * @param  port : one of the gpio port
+  * @param  pin : one of the gpio pin
+  * @param  val : 0 to set to low, any other value to set to high
+  * @retval None
+  */
+static inline void digital_io_write(GPIO_TypeDef *port, uint32_t pin, uint32_t val)
+{
+  if(val) {
+    LL_GPIO_SetOutputPin(port, pin);
+  } else {
+    LL_GPIO_ResetOutputPin(port, pin);
+  }
+}
+
+
+/**
+  * @brief  This function set a value to an IO
+  * @param  port : one of the gpio port
+  * @param  pin : one of the gpio pin
+  * @retval The pin state (LOW or HIGH)
+  */
+static inline uint32_t digital_io_read(GPIO_TypeDef *port, uint32_t pin)
+{
+  return LL_GPIO_IsInputPinSet(port, pin);
+}
 
 #ifdef __cplusplus
 }