[rtems commit] bsps: Add gicv3_sgi_ppi_disable()

[Sebastian Huber]

Module:    rtems
Branch:    master
Commit:    ea353b4bfabc4ce857b4fdff884f53b61d01997b
Changeset: http://git.rtems.org/rtems/commit/?id=ea353b4bfabc4ce857b4fdff884f53b61d01997b

Author:    Sebastian Huber <sebastian.huber at embedded-brains.de>
Date:      Mon Mar 14 15:50:24 2022 +0100

bsps: Add gicv3_sgi_ppi_disable()

---

 bsps/include/dev/irq/arm-gicv3.h | 10 ++++++++++
 bsps/shared/dev/irq/arm-gicv3.c  |  5 +----
 2 files changed, 11 insertions(+), 4 deletions(-)

diff --git a/bsps/include/dev/irq/arm-gicv3.h b/bsps/include/dev/irq/arm-gicv3.h
index effa7a8ffb..37e0d433cc 100644
--- a/bsps/include/dev/irq/arm-gicv3.h
+++ b/bsps/include/dev/irq/arm-gicv3.h
@@ -171,6 +171,16 @@ static inline void gicv3_sgi_ppi_enable(
   sgi_ppi->icspiser[0] = 1U << vector;
 }
 
+static inline void gicv3_sgi_ppi_disable(
+  rtems_vector_number vector,
+  uint32_t            cpu_index
+)
+{
+  volatile gic_sgi_ppi *sgi_ppi = gicv3_get_sgi_ppi(cpu_index);
+
+  sgi_ppi->icspicer[0] = 1U << vector;
+}
+
 static inline bool gicv3_sgi_ppi_is_enabled(
   rtems_vector_number vector,
   uint32_t            cpu_index
diff --git a/bsps/shared/dev/irq/arm-gicv3.c b/bsps/shared/dev/irq/arm-gicv3.c
index c71a9f15ab..6c623f0ccb 100644
--- a/bsps/shared/dev/irq/arm-gicv3.c
+++ b/bsps/shared/dev/irq/arm-gicv3.c
@@ -192,10 +192,7 @@ rtems_status_code bsp_interrupt_vector_disable(rtems_vector_number vector)
 
     gic_id_disable(dist, vector);
   } else {
-    volatile gic_sgi_ppi *sgi_ppi =
-      gicv3_get_sgi_ppi(_SMP_Get_current_processor());
-
-    sgi_ppi->icspicer[0] = 1U << vector;
+    gicv3_sgi_ppi_disable(vector, _SMP_Get_current_processor());
   }
 
   return RTEMS_SUCCESSFUL;