RTOS/rtems
1
0
Fork 0
forked from Imagelibrary/rtems
Code Pull Requests Activity

bsps: Add gicv3_sgi_ppi_enable()

Browse Source
This commit is contained in:
Sebastian Huber
2022-03-14 15:49:25 +01:00
parent 42c806fc84
commit f74b120c24
2 changed files with 16 additions and 9 deletions
Download Patch File Download Diff File Expand all files Collapse all files

15
bsps/include/dev/irq/arm-gicv3.h
View File

@@ -156,6 +156,21 @@ static inline volatile gic_sgi_ppi *gicv3_get_sgi_ppi(uint32_t cpu_index)
((uintptr_t)BSP_ARM_GIC_REDIST_BASE + cpu_index * 0x20000 + 0x10000);
}
static inline void gicv3_sgi_ppi_enable(
rtems_vector_number vector,
uint32_t cpu_index
)
{
volatile gic_sgi_ppi *sgi_ppi = gicv3_get_sgi_ppi(cpu_index);
/* Set G1NS */
sgi_ppi->icspigrpr[0] |= 1U << vector;
sgi_ppi->icspigrpmodr[0] &= ~(1U << vector);
/* Set enable */
sgi_ppi->icspiser[0] = 1U << vector;
}
static inline bool gicv3_sgi_ppi_is_enabled(
rtems_vector_number vector,
uint32_t cpu_index

10
bsps/shared/dev/irq/arm-gicv3.c
View File

@@ -177,15 +177,7 @@ rtems_status_code bsp_interrupt_vector_enable(rtems_vector_number vector)
gic_id_enable(dist, vector);
} else {
volatile gic_sgi_ppi *sgi_ppi =
gicv3_get_sgi_ppi(_SMP_Get_current_processor());
/* Set G1NS */
sgi_ppi->icspigrpr[0] |= 1U << vector;
sgi_ppi->icspigrpmodr[0] &= ~(1U << vector);
/* Set enable */
sgi_ppi->icspiser[0] = 1U << vector;
gicv3_sgi_ppi_enable(vector, _SMP_Get_current_processor());
}
return RTEMS_SUCCESSFUL;