Mirrors_Framework/rtems
1
0
Fork 0
mirror of https://gitlab.rtems.org/rtems/rtos/rtems.git synced 2026-09-22 12:18:21 +08:00
Code Issues Packages Projects Releases Wiki Activity

bsps: Move gicv3_init_dist()

Browse Source 
Make the distributor register block a parameter.
This commit is contained in:
Sebastian Huber
2022-04-06 09:48:52 +02:00
parent ea353b4bfa
commit b3519336fd
2 changed files with 38 additions and 39 deletions
Download Patch File Download Diff File Expand all files Collapse all files
bsps/include/dev/irq/arm-gicv3.h
+37
View File
@@ -242,6 +242,43 @@ static inline void gicv3_trigger_sgi(
WRITE64_SR(ICC_SGI1, value);
}
static inline uint32_t gicv3_get_id_count(volatile gic_dist *dist)
{
uint32_t id_count = GIC_DIST_ICDICTR_IT_LINES_NUMBER_GET(dist->icdictr);
id_count = 32 * (id_count + 1);
id_count = id_count <= 1020 ? id_count : 1020;
return id_count;
}
static void gicv3_init_dist(volatile gic_dist *dist)
{
uint32_t id_count = gicv3_get_id_count(dist);
uint32_t id;
dist->icddcr = GIC_DIST_ICDDCR_ARE_NS | GIC_DIST_ICDDCR_ARE_S
| GIC_DIST_ICDDCR_ENABLE_GRP1S | GIC_DIST_ICDDCR_ENABLE_GRP1NS
| GIC_DIST_ICDDCR_ENABLE_GRP0;
for (id = 0; id < id_count; id += 32) {
/* Disable all interrupts */
dist->icdicer[id / 32] = 0xffffffff;
/* Set G1NS */
dist->icdigr[id / 32] = 0xffffffff;
dist->icdigmr[id / 32] = 0;
}
for (id = 0; id < id_count; ++id) {
gic_id_set_priority(dist, id, PRIORITY_DEFAULT);
}
for (id = 32; id < id_count; ++id) {
gic_id_set_targets(dist, id, 0x01);
}
}
#ifdef __cplusplus
}
#endif