From afd41aade1bc1a9a8de23e7754ef4e8c441c0865 Mon Sep 17 00:00:00 2001
From: =?UTF-8?q?=E3=81=82=E3=81=8F?= <alleteam@gmail.com>
Date: Wed, 7 Feb 2024 16:09:29 +0700
Subject: [PATCH] FuriHal: various GPIO improvements (#3406)

---
 furi/core/common_defines.h          |  4 ++++
 targets/f7/furi_hal/furi_hal_gpio.c | 32 +++++++++++++++++++++--------
 targets/f7/furi_hal/furi_hal_gpio.h |  1 -
 3 files changed, 27 insertions(+), 10 deletions(-)

diff --git a/furi/core/common_defines.h b/furi/core/common_defines.h
index b0062e659..2fc12dedb 100644
--- a/furi/core/common_defines.h
+++ b/furi/core/common_defines.h
@@ -21,6 +21,10 @@ extern "C" {
 #define FURI_PACKED __attribute__((packed))
 #endif
 
+#ifndef FURI_ALWAYS_STATIC_INLINE
+#define FURI_ALWAYS_STATIC_INLINE __attribute__((always_inline)) static inline
+#endif
+
 #ifndef FURI_IS_IRQ_MASKED
 #define FURI_IS_IRQ_MASKED() (__get_PRIMASK() != 0U)
 #endif
diff --git a/targets/f7/furi_hal/furi_hal_gpio.c b/targets/f7/furi_hal/furi_hal_gpio.c
index d5221aba9..1e703b5d1 100644
--- a/targets/f7/furi_hal/furi_hal_gpio.c
+++ b/targets/f7/furi_hal/furi_hal_gpio.c
@@ -129,11 +129,9 @@ void furi_hal_gpio_init_ex(
         LL_GPIO_SetPinMode(gpio->port, gpio->pin, LL_GPIO_MODE_INPUT);
         LL_SYSCFG_SetEXTISource(sys_exti_port, sys_exti_line);
         if(mode == GpioModeInterruptRise || mode == GpioModeInterruptRiseFall) {
-            LL_EXTI_EnableIT_0_31(exti_line);
             LL_EXTI_EnableRisingTrig_0_31(exti_line);
         }
         if(mode == GpioModeInterruptFall || mode == GpioModeInterruptRiseFall) {
-            LL_EXTI_EnableIT_0_31(exti_line);
             LL_EXTI_EnableFallingTrig_0_31(exti_line);
         }
         if(mode == GpioModeEventRise || mode == GpioModeEventRiseFall) {
@@ -149,6 +147,7 @@ void furi_hal_gpio_init_ex(
         if(LL_SYSCFG_GetEXTISource(sys_exti_line) == sys_exti_port &&
            LL_EXTI_IsEnabledIT_0_31(exti_line)) {
             LL_EXTI_DisableIT_0_31(exti_line);
+            LL_EXTI_ClearFlag_0_31(exti_line);
             LL_EXTI_DisableRisingTrig_0_31(exti_line);
             LL_EXTI_DisableFallingTrig_0_31(exti_line);
         }
@@ -199,11 +198,15 @@ void furi_hal_gpio_add_int_callback(const GpioPin* gpio, GpioExtiCallback cb, vo
     furi_assert(cb);
 
     FURI_CRITICAL_ENTER();
+
     uint8_t pin_num = furi_hal_gpio_get_pin_num(gpio);
     furi_check(gpio_interrupt[pin_num].callback == NULL);
     gpio_interrupt[pin_num].callback = cb;
     gpio_interrupt[pin_num].context = ctx;
-    gpio_interrupt[pin_num].ready = true;
+
+    const uint32_t exti_line = GET_EXTI_LINE(gpio->pin);
+    LL_EXTI_EnableIT_0_31(exti_line);
+
     FURI_CRITICAL_EXIT();
 }
 
@@ -211,10 +214,13 @@ void furi_hal_gpio_enable_int_callback(const GpioPin* gpio) {
     furi_assert(gpio);
 
     FURI_CRITICAL_ENTER();
+
     uint8_t pin_num = furi_hal_gpio_get_pin_num(gpio);
     if(gpio_interrupt[pin_num].callback) {
-        gpio_interrupt[pin_num].ready = true;
+        const uint32_t exti_line = GET_EXTI_LINE(gpio->pin);
+        LL_EXTI_EnableIT_0_31(exti_line);
     }
+
     FURI_CRITICAL_EXIT();
 }
 
@@ -222,8 +228,11 @@ void furi_hal_gpio_disable_int_callback(const GpioPin* gpio) {
     furi_assert(gpio);
 
     FURI_CRITICAL_ENTER();
-    uint8_t pin_num = furi_hal_gpio_get_pin_num(gpio);
-    gpio_interrupt[pin_num].ready = false;
+
+    const uint32_t exti_line = GET_EXTI_LINE(gpio->pin);
+    LL_EXTI_DisableIT_0_31(exti_line);
+    LL_EXTI_ClearFlag_0_31(exti_line);
+
     FURI_CRITICAL_EXIT();
 }
 
@@ -231,15 +240,20 @@ void furi_hal_gpio_remove_int_callback(const GpioPin* gpio) {
     furi_assert(gpio);
 
     FURI_CRITICAL_ENTER();
+
+    const uint32_t exti_line = GET_EXTI_LINE(gpio->pin);
+    LL_EXTI_DisableIT_0_31(exti_line);
+    LL_EXTI_ClearFlag_0_31(exti_line);
+
     uint8_t pin_num = furi_hal_gpio_get_pin_num(gpio);
     gpio_interrupt[pin_num].callback = NULL;
     gpio_interrupt[pin_num].context = NULL;
-    gpio_interrupt[pin_num].ready = false;
+
     FURI_CRITICAL_EXIT();
 }
 
-static void furi_hal_gpio_int_call(uint16_t pin_num) {
-    if(gpio_interrupt[pin_num].callback && gpio_interrupt[pin_num].ready) {
+FURI_ALWAYS_STATIC_INLINE void furi_hal_gpio_int_call(uint16_t pin_num) {
+    if(gpio_interrupt[pin_num].callback) {
         gpio_interrupt[pin_num].callback(gpio_interrupt[pin_num].context);
     }
 }
diff --git a/targets/f7/furi_hal/furi_hal_gpio.h b/targets/f7/furi_hal/furi_hal_gpio.h
index 0999971bc..9e78872bb 100644
--- a/targets/f7/furi_hal/furi_hal_gpio.h
+++ b/targets/f7/furi_hal/furi_hal_gpio.h
@@ -24,7 +24,6 @@ typedef void (*GpioExtiCallback)(void* ctx);
 typedef struct {
     GpioExtiCallback callback;
     void* context;
-    volatile bool ready;
 } GpioInterrupt;
 
 /**