gxbb: Implement PSCI_CPU_OFF

This works fine for CPU1-3, but it fails for CPU0, where it is simply
ignored and leaves CPU0 in a WFI loop.

Change-Id: I7d73683fdd894f2021d6a5bc2cce6cd03e18e633
Signed-off-by: Antonio Nino Diaz <antonio.ninodiaz@arm.com>

diff --git a/plat/meson/gxbb/gxbb_pm.c b/plat/meson/gxbb/gxbb_pm.c
index 6a13159a8224cbc0a0fa222c0486312b7b214b1e..632a53f46c43241d484b0a37be6347c66c036fdb 100644 (file)
--- a/plat/meson/gxbb/gxbb_pm.c
+++ b/plat/meson/gxbb/gxbb_pm.c
@@ -101,12 +101,28 @@ static void gxbb_pwr_domain_on_finish(const psci_power_state_t *target_state)
        gicv2_cpuif_enable();
 }
 
+static void gxbb_pwr_domain_off(const psci_power_state_t *target_state)
+{
+       u_register_t mpidr = read_mpidr_el1();
+       unsigned int core = plat_gxbb_calc_core_pos(mpidr);
+       uintptr_t addr = GXBB_PSCI_MAILBOX_BASE + 8 + (core << 4);
+
+       mmio_write_32(addr, 0xFFFFFFFF);
+       flush_dcache_range(addr, sizeof(uint32_t));
+
+       gicv2_cpuif_disable();
+
+       scpi_set_css_power_state(mpidr,
+                                SCPI_POWER_OFF, SCPI_POWER_ON, SCPI_POWER_ON);
+}
+
 /*******************************************************************************
  * Platform handlers and setup function.
  ******************************************************************************/
 static const plat_psci_ops_t gxbb_ops = {
        .pwr_domain_on                  = gxbb_pwr_domain_on,
        .pwr_domain_on_finish           = gxbb_pwr_domain_on_finish,
+       .pwr_domain_off                 = gxbb_pwr_domain_off,
        .system_off                     = gxbb_system_off,
        .system_reset                   = gxbb_system_reset,
 };