From 663ce5bf554c3ee92ef72304b775a794ce3cacd0 Mon Sep 17 00:00:00 2001
From: KLASSENTS <klassen@elron.tech>
Date: Mon, 17 Mar 2025 10:06:57 +0700
Subject: [PATCH] =?UTF-8?q?=D1=83=D1=81=D0=BA=D0=BE=D1=80=D0=B5=D0=BD?=
 =?UTF-8?q?=D0=B8=D0=B5=20=D1=80=D0=B0=D0=B1=D0=BE=D1=82=D1=8B=20=D1=84?=
 =?UTF-8?q?=D1=83=D0=BD=D0=BA=D1=86=D0=B8=D0=B9=20digital?=
MIME-Version: 1.0
Content-Type: text/plain; charset=UTF-8
Content-Transfer-Encoding: 8bit

---
 variants/elsomik/pins_arduino.h | 15 ++++++++-------
 variants/elsomik/variant.c      | 29 +++++++++++++----------------
 2 files changed, 21 insertions(+), 23 deletions(-)

diff --git a/variants/elsomik/pins_arduino.h b/variants/elsomik/pins_arduino.h
index adebe90..282f608 100644
--- a/variants/elsomik/pins_arduino.h
+++ b/variants/elsomik/pins_arduino.h
@@ -71,6 +71,8 @@ typedef enum
   P2_7,             // 33
   PINS_COMMON_QTY,  // 34
 } DigitalPinsTypeDef;
+// total number of pins available for initialization
+#define pinCommonQty()    (PINS_COMMON_QTY)
 
 // analog pins
 #define PIN_A0        (P1_5)
@@ -96,11 +98,6 @@ static const uint8_t A7 = PIN_A7;
 GPIO_TypeDef* digitalPinToPort(uint32_t digPinNumber);     
 // determines the pin address inside the port by the board pin number
 HAL_PinsTypeDef digitalPinToBitMask(uint32_t digitalPinNumber);
-// total number of pins available for initialization
-static inline uint16_t pinCommonQty(void)
-{
-  return (uint16_t)PINS_COMMON_QTY;
-}
 // the function returns a reference to the OUTPUT address of the GPIO register
 volatile uint32_t* portOutputRegister(GPIO_TypeDef* GPIO_x);
 // the function returns a reference to the STATE address of the GPIO register
@@ -120,8 +117,12 @@ uint32_t analogInputToChannelNumber(uint32_t PinNumber);
 
 // PWM
 #define PWM_FREQUENCY_MAX         1000000 // Hz
-bool digitalPinHasPWM(uint8_t p);
-bool digitalPinPwmIsOn(uint8_t digitalPin); // use only if digitalPinHasPWM() == true
+static inline __attribute__((always_inline)) bool digitalPinHasPWM(uint8_t p)
+{
+  return (p <= P1_15) && ((p & 0xF) < 4);
+}
+// return true if digitalPin configured as pwm
+bool digitalPinPwmIsOn(uint8_t digitalPin);
 // determines which timer the pin belongs to
 TIMER32_TypeDef* pwmPinToTimer(uint32_t digPinNumber);
 // determines which timer channel the pin belongs to
diff --git a/variants/elsomik/variant.c b/variants/elsomik/variant.c
index 5f51a41..cff665c 100644
--- a/variants/elsomik/variant.c
+++ b/variants/elsomik/variant.c
@@ -21,7 +21,7 @@
  * @return The address of the port corresponding to the board pin number. Can return 0 if the pin not exists
  */
 
-GPIO_TypeDef *digitalPinToPort(uint32_t digitalPinNumber)
+ __attribute__((noinline, section(".ram_text"))) GPIO_TypeDef *digitalPinToPort(uint32_t digitalPinNumber)
 {
   if (digitalPinNumber >= pinCommonQty())
   {
@@ -40,7 +40,7 @@ GPIO_TypeDef *digitalPinToPort(uint32_t digitalPinNumber)
 }
 
 // determines the pin address inside the port by the board pin number
-HAL_PinsTypeDef digitalPinToBitMask(uint32_t digitalPinNumber)
+__attribute__((noinline, section(".ram_text"))) HAL_PinsTypeDef digitalPinToBitMask(uint32_t digitalPinNumber)
 {
   if (digitalPinNumber >= PINS_COMMON_QTY)
   {
@@ -112,25 +112,22 @@ uint32_t analogInputToChannelNumber(uint32_t PinNumber)
 // return true if digitalPin configured as pwm
 bool digitalPinPwmIsOn(uint8_t digitalPin)
 {
-  uint8_t config = 0;
-  uint8_t pinShift = digitalPin & 0x3;
+  if (digitalPinHasPWM(digitalPin))
+  {
+    uint8_t config = 0;
+    uint8_t pinShift = digitalPin & 0x3;
 
-  if (PWM_PIN_TO_PORT_NUMBER(digitalPin) == 0)
-    config = PIN_GET_PAD_CONFIG(PORT_0_CFG, pinShift);
-  else
-    config = PIN_GET_PAD_CONFIG(PORT_1_CFG, pinShift);
+    if (PWM_PIN_TO_PORT_NUMBER(digitalPin) == 0)
+      config = PIN_GET_PAD_CONFIG(PORT_0_CFG, pinShift);
+    else
+      config = PIN_GET_PAD_CONFIG(PORT_1_CFG, pinShift);
 
-  if (config == 2)
-    return true;
-  else
+    if (config == 2)
+      return true;
+  }
     return false;
 }
 
-bool digitalPinHasPWM(uint8_t digitalPin)
-{
-  return (digitalPin <= P1_15) && ((digitalPin & 0xF) < 4);
-}
-
 // function is used only if digitalPinHasPWM() is true
 TIMER32_TypeDef *pwmPinToTimer(uint32_t digPinNumber)
 {