Add digitalRead/WriteFast API

Use the PinName (PY_n) instead of the pin number (Pyn)

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

Author: fpistm

cores/arduino/stm32/digital_io.c

@@ -36,8 +36,6 @@
   ******************************************************************************
   */
 #include "digital_io.h"
-#include "stm32_def.h"
-#include "hw_config.h"
 #include "PinAF_STM32F1.h"
 
 #ifdef __cplusplus

cores/arduino/stm32/digital_io.h

@@ -40,8 +40,8 @@
 #define __DIGITAL_IO_H
 
 /* Includes ------------------------------------------------------------------*/
-#include "stm32_def.h"
-#include "PeripheralPins.h"
+#include "wiring_constants.h"
+#include "PinNames.h"
 #include "stm32yyxx_ll_gpio.h"
 
 #ifdef __cplusplus
@@ -70,7 +70,6 @@ static inline void digital_io_write(GPIO_TypeDef *port, uint32_t pin, uint32_t v
   }
 }
 
-
 /**
   * @brief  This function set a value to an IO
   * @param  port : one of the gpio port
@@ -82,6 +81,33 @@ static inline uint32_t digital_io_read(GPIO_TypeDef *port, uint32_t pin)
   return LL_GPIO_IsInputPinSet(port, pin);
 }
 
+/**
+  * @brief  This function set a value to an IO
+  * @param  pn : Pin name
+  * @param  val : 0 to set to low, any other value to set to high
+  * @retval None
+  */
+static inline void digitalWriteFast( PinName pn, uint32_t ulVal )
+{
+  if(pn != NC) {
+    digital_io_write(get_GPIO_Port(STM_PORT(pn)), STM_GPIO_PIN(pn), ulVal);
+  }
+}
+
+/**
+  * @brief  This function read the value of an IO
+  * @param  pn : Pin name
+  * @retval The pin state (LOW or HIGH)
+  */
+static inline int digitalReadFast( PinName pn )
+{
+  uint8_t level = 0;
+  if(pn != NC) {
+    level = digital_io_read(get_GPIO_Port(STM_PORT(pn)), STM_GPIO_PIN(pn));
+  }
+  return (level)? HIGH : LOW;
+}
+
 #ifdef __cplusplus
 }
 #endif

cores/arduino/wiring_digital.c

@@ -70,20 +70,12 @@ void pinMode( uint32_t ulPin, uint32_t ulMode )
 
 void digitalWrite( uint32_t ulPin, uint32_t ulVal )
 {
-  PinName p = digitalPinToPinName(ulPin);
-  if(p != NC) {
-    digital_io_write(get_GPIO_Port(STM_PORT(p)), STM_GPIO_PIN(p), ulVal);
-  }
+  digitalWriteFast(digitalPinToPinName(ulPin), ulVal);
 }
 
 int digitalRead( uint32_t ulPin )
 {
-  uint8_t level = 0;
-  PinName p = digitalPinToPinName(ulPin);
-  if(p != NC) {
-    level = digital_io_read(get_GPIO_Port(STM_PORT(p)), STM_GPIO_PIN(p));
-  }
-  return (level)? HIGH : LOW;
+  return digitalReadFast(digitalPinToPinName(ulPin));
 }
 
 #ifdef __cplusplus

keywords.txt

@@ -350,6 +350,8 @@ portConfigRegister	KEYWORD2
 digitalPinIsValid	KEYWORD2
 digitalPinFirstOccurence	KEYWORD2
 pinIsSerial	KEYWORD2
+digitalReadFast	KEYWORD2
+digitalWriteFast	KEYWORD2
 
 # Pin number
 PA0	LITERAL1