diff options
author | Nitin Garg <nitin.garg@nxp.com> | 2018-05-10 13:21:23 -0500 |
---|---|---|
committer | Abel Vesa <abel.vesa@nxp.com> | 2018-06-11 10:33:03 +0300 |
commit | c6bfdc70d29981ceef708c36fcb6e0e80891b818 (patch) | |
tree | b81f2a6fbae5a1cfcd169e957277a3c25f823fd4 /plat/imx/imx8qxp/imx8qxp_psci.c | |
parent | 146f4caf3c60fb323db12a4ff3c960c8f08d6f17 (diff) |
plat: imx: Fix the IRQSTR power modes for iMX8QM/QXP
make sure to put IRQSTEER SCU into correct power modes.
Signed-off-by: Nitin Garg <nitin.garg@nxp.com>
Diffstat (limited to 'plat/imx/imx8qxp/imx8qxp_psci.c')
-rw-r--r-- | plat/imx/imx8qxp/imx8qxp_psci.c | 16 |
1 files changed, 12 insertions, 4 deletions
diff --git a/plat/imx/imx8qxp/imx8qxp_psci.c b/plat/imx/imx8qxp/imx8qxp_psci.c index e01b602c..baafc73d 100644 --- a/plat/imx/imx8qxp/imx8qxp_psci.c +++ b/plat/imx/imx8qxp/imx8qxp_psci.c @@ -38,20 +38,32 @@ static void imx_enable_irqstr_wakeup(void) uint32_t irq_mask; gicv3_dist_ctx_t *dist_ctx = &imx_gicv3_ctx.dist_ctx; + /* put IRQSTR into ON mode */ + sc_pm_set_resource_power_mode(ipc_handle, SC_R_IRQSTR_SCU2, SC_PM_PW_MODE_ON); + /* enable the irqsteer to handle wakeup irq */ mmio_write_32(IMX_WUP_IRQSTR, 0x1); for (int i = 0; i < 15; i++) { irq_mask = dist_ctx->gicd_isenabler[i]; mmio_write_32(IMX_WUP_IRQSTR + 0x3c - 0x4 * i, irq_mask); } + + /* put IRQSTR into STBY mode */ + sc_pm_set_resource_power_mode(ipc_handle, SC_R_IRQSTR_SCU2, SC_PM_PW_MODE_STBY); } static void imx_disable_irqstr_wakeup(void) { + /* Put IRQSTEER back to ON mode */ + sc_pm_set_resource_power_mode(ipc_handle, SC_R_IRQSTR_SCU2, SC_PM_PW_MODE_ON); + /* disable the irqsteer */ mmio_write_32(IMX_WUP_IRQSTR, 0x0); for (int i = 0; i < 16; i ++) mmio_write_32(IMX_WUP_IRQSTR + 0x4 + 0x4 * i, 0x0); + + /* Put IRQSTEER into OFF mode */ + sc_pm_set_resource_power_mode(ipc_handle, SC_R_IRQSTR_SCU2, SC_PM_PW_MODE_OFF); } plat_local_state_t plat_get_target_pwr_state(unsigned int lvl, @@ -176,8 +188,6 @@ void imx_domain_suspend(const psci_power_state_t *target_state) /* Put GIC in OFF mode. */ sc_pm_set_resource_power_mode(ipc_handle, SC_R_GIC, SC_PM_PW_MODE_OFF); - /* put IRQSTR in STBY mode */ - sc_pm_set_resource_power_mode(ipc_handle, SC_R_IRQSTR_SCU2, SC_PM_PW_MODE_STBY); sc_pm_set_cpu_resume_addr(ipc_handle, ap_core_index[cpu_id], 0x080000000); sc_pm_req_cpu_low_power_mode(ipc_handle, ap_core_index[cpu_id], SC_PM_PW_MODE_OFF, SC_PM_WAKE_SRC_IRQSTEER); @@ -193,8 +203,6 @@ void imx_domain_suspend_finish(const psci_power_state_t *target_state) /* Put GIC back to high power mode. */ sc_pm_set_resource_power_mode(ipc_handle, SC_R_GIC, SC_PM_PW_MODE_ON); - /* Put IRQSTEER back to high power mode */ - sc_pm_set_resource_power_mode(ipc_handle, SC_R_IRQSTR_SCU2, SC_PM_PW_MODE_ON); /* restore gic context */ plat_gic_restore(cpu_id, &imx_gicv3_ctx); |