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

bsps: Add GICv3 arm_gic_irq_processor_count()

Browse Source 
Update #4202.
This commit is contained in:
Sebastian Huber
2020-12-10 09:09:10 +01:00
parent 7cf7e1d61d
commit 747fb65c6e
3 changed files with 35 additions and 6 deletions
Download Patch File Download Diff File Expand all files Collapse all files

7
bsps/include/dev/irq/arm-gic-irq.h
View File

@@ -116,12 +116,7 @@ void arm_interrupt_handler_dispatch(rtems_vector_number vector);
*/
void gicvx_interrupt_dispatch(void);
static inline uint32_t arm_gic_irq_processor_count(void)
{
volatile gic_dist *dist = ARM_GIC_DIST;
return GIC_DIST_ICDICTR_CPU_NUMBER_GET(dist->icdictr) + 1;
}
uint32_t arm_gic_irq_processor_count(void);
void arm_gic_irq_initialize_secondary_cpu(void);

7
bsps/shared/dev/irq/arm-gicv2.c
View File

@@ -269,3 +269,10 @@ void arm_gic_trigger_sgi(rtems_vector_number vector, uint32_t targets)
#endif
| GIC_DIST_ICDSGIR_SGIINTID(vector);
}
uint32_t arm_gic_irq_processor_count(void)
{
volatile gic_dist *dist = ARM_GIC_DIST;
return GIC_DIST_ICDICTR_CPU_NUMBER_GET(dist->icdictr) + 1;
}

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

@@ -354,3 +354,30 @@ void arm_gic_trigger_sgi(rtems_vector_number vector, uint32_t targets)
#endif
WRITE64_SR(ICC_SGI1, value);
}
uint32_t arm_gic_irq_processor_count(void)
{
volatile gic_dist *dist = ARM_GIC_DIST;
uint32_t cpu_count;
if ((dist->icddcr & GIC_DIST_ICDDCR_ARE_S) == 0) {
cpu_count = GIC_DIST_ICDICTR_CPU_NUMBER_GET(dist->icdictr) + 1;
} else {
int i;
/* Assume that an interrupt export port exists */
cpu_count = 0;
for (i = 0; i < CPU_MAXIMUM_PROCESSORS; ++i) {
volatile gic_redist *redist = gicv3_get_redist(i);
if ((redist->icrtyper & GIC_REDIST_ICRTYPER_LAST) != 0) {
break;
}
++cpu_count;
}
}
return cpu_count;
}