soc: stm32: add parameter in link_layer_register_isr() function

add parameter to the link_layer_register_isr() to force
or not the link layer isr registration in case of multiple
function calls

Signed-off-by: Vincent Tardy <vincent.tardy@st.com>

Author: vtardy-st

soc/st/stm32/stm32wbax/hci_if/linklayer_plat_adapt.c

@@ -38,6 +38,8 @@ static uint32_t primask_bit;
 /* Radio SW low ISR global variable */
 volatile uint8_t radio_sw_low_isr_is_running_high_prio;
 
+/* ISR registration state variable */
+static uint8_t is_isr_registered = 0;
 
 void LINKLAYER_PLAT_DelayUs(uint32_t delay)
 {
@@ -96,27 +98,33 @@ void radio_low_prio_isr(void)
 }
 
 
-void link_layer_register_isr(void)
+void link_layer_register_isr(uint8_t force)
 {
-	ARM_IRQ_DIRECT_DYNAMIC_CONNECT(RADIO_INTR_NUM, 0, 0, reschedule);
 
-	/* Ensure the IRQ is disabled before enabling it at run time */
-	irq_disable(RADIO_INTR_NUM);
+	if ((force == 1) || (is_isr_registered == 0)) {
 
-	irq_connect_dynamic(RADIO_INTR_NUM, RADIO_INTR_PRIO_HIGH_Z,
-			    (void (*)(const void *))radio_high_prio_isr, NULL, 0);
+		is_isr_registered = 1;
 
-	irq_enable(RADIO_INTR_NUM);
+		ARM_IRQ_DIRECT_DYNAMIC_CONNECT(RADIO_INTR_NUM, 0, 0, reschedule);
 
-	ARM_IRQ_DIRECT_DYNAMIC_CONNECT(RADIO_SW_LOW_INTR_NUM, 0, 0, reschedule);
+		/* Ensure the IRQ is disabled before enabling it at run time */
+		irq_disable(RADIO_INTR_NUM);
 
-	/* Ensure the IRQ is disabled before enabling it at run time */
-	irq_disable(RADIO_SW_LOW_INTR_NUM);
+		irq_connect_dynamic(RADIO_INTR_NUM, RADIO_INTR_PRIO_HIGH_Z,
+				    (void (*)(const void *))radio_high_prio_isr, NULL, 0);
 
-	irq_connect_dynamic(RADIO_SW_LOW_INTR_NUM, RADIO_SW_LOW_INTR_PRIO,
-			    (void (*)(const void *))radio_low_prio_isr, NULL, 0);
+		irq_enable(RADIO_INTR_NUM);
 
-	irq_enable(RADIO_SW_LOW_INTR_NUM);
+		ARM_IRQ_DIRECT_DYNAMIC_CONNECT(RADIO_SW_LOW_INTR_NUM, 0, 0, reschedule);
+
+		/* Ensure the IRQ is disabled before enabling it at run time */
+		irq_disable(RADIO_SW_LOW_INTR_NUM);
+
+		irq_connect_dynamic(RADIO_SW_LOW_INTR_NUM, RADIO_SW_LOW_INTR_PRIO,
+				    (void (*)(const void *))radio_low_prio_isr, NULL, 0);
+
+		irq_enable(RADIO_SW_LOW_INTR_NUM);
+	}
 }
 
 

soc/st/stm32/stm32wbax/hci_if/linklayer_plat_local.h

@@ -8,6 +8,6 @@
 #ifndef _STM32WBA_LINK_LAYER_PLAT_LOCAL_H_
 #define _STM32WBA_LINK_LAYER_PLAT_LOCAL_H_
 
-void link_layer_register_isr(void);
+void link_layer_register_isr(uint8_t force);
 
 #endif /* _STM32WBA_LINK_LAYER_PLAT_LOCAL_H_ */