123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123 |
- #include <assert.h>
- #include <arch_helpers.h>
- #include <drivers/arm/arm_gicv3_common.h>
- #include <drivers/arm/gicv3.h>
- #include "gicv3_private.h"
- void arm_gicv3_distif_pre_save(unsigned int rdist_proc_num)
- {
- uintptr_t gicr_base = 0;
- unsigned int typer_reg;
- assert(gicv3_driver_data);
- assert(gicv3_driver_data->rdistif_base_addrs);
- assert(gicv3_driver_data->gicd_base != 0U);
- typer_reg = gicd_read_typer(gicv3_driver_data->gicd_base);
-
- for (unsigned int i = 0; i < gicv3_driver_data->rdistif_num; i++) {
- gicr_base = gicv3_driver_data->rdistif_base_addrs[i];
- assert(gicr_base);
- assert(gicr_read_waker(gicr_base) & WAKER_CA_BIT);
- assert(gicr_read_waker(gicr_base) & WAKER_PS_BIT);
- }
- gicr_base = gicv3_driver_data->rdistif_base_addrs[rdist_proc_num];
-
-
- gicr_write_waker(gicr_base, gicr_read_waker(gicr_base) | WAKER_SL_BIT);
-
- if ((typer_reg & TYPER_LPIS) != 0U) {
- while (!(gicr_read_waker(gicr_base) & WAKER_QSC_BIT))
- ;
- }
- }
- void arm_gicv3_distif_post_restore(unsigned int rdist_proc_num)
- {
- uintptr_t gicr_base;
- assert(gicv3_driver_data);
- assert(gicv3_driver_data->rdistif_base_addrs);
-
- gicr_base = gicv3_driver_data->rdistif_base_addrs[rdist_proc_num];
- assert(gicr_base);
-
- if (!(gicr_read_waker(gicr_base) & WAKER_SL_BIT))
- return;
-
- assert(gicr_read_waker(gicr_base) & WAKER_QSC_BIT);
-
- gicr_write_waker(gicr_base, gicr_read_waker(gicr_base) & ~WAKER_SL_BIT);
-
- while (gicr_read_waker(gicr_base) & WAKER_QSC_BIT)
- ;
- }
|