forked from Imagelibrary/rtems
bsps: Add gicv3_sgi_ppi_set_priority()
This commit is contained in:
@@ -191,6 +191,17 @@ static inline bool gicv3_sgi_ppi_is_enabled(
|
||||
return (sgi_ppi->icspiser[0] & (1U << vector)) != 0;
|
||||
}
|
||||
|
||||
static inline void gicv3_sgi_ppi_set_priority(
|
||||
rtems_vector_number vector,
|
||||
uint8_t priority,
|
||||
uint32_t cpu_index
|
||||
)
|
||||
{
|
||||
volatile gic_sgi_ppi *sgi_ppi = gicv3_get_sgi_ppi(cpu_index);
|
||||
|
||||
sgi_ppi->icspiprior[vector] = priority;
|
||||
}
|
||||
|
||||
static inline bool gicv3_sgi_ppi_is_pending(
|
||||
rtems_vector_number vector,
|
||||
uint32_t cpu_index
|
||||
|
||||
@@ -230,9 +230,11 @@ rtems_status_code arm_gic_irq_set_priority(
|
||||
volatile gic_dist *dist = ARM_GIC_DIST;
|
||||
gic_id_set_priority(dist, vector, priority);
|
||||
} else {
|
||||
volatile gic_sgi_ppi *sgi_ppi =
|
||||
gicv3_get_sgi_ppi(_SMP_Get_current_processor());
|
||||
sgi_ppi->icspiprior[vector] = priority;
|
||||
gicv3_sgi_ppi_set_priority(
|
||||
vector,
|
||||
priority,
|
||||
_SMP_Get_current_processor()
|
||||
);
|
||||
}
|
||||
} else {
|
||||
sc = RTEMS_INVALID_ID;
|
||||
|
||||
Reference in New Issue
Block a user