From 685dddb758f14790299f78844146d9b12a731bac Mon Sep 17 00:00:00 2001 From: Anson Huang Date: Wed, 16 Aug 2017 22:09:45 +0800 Subject: imx8mq: enable PU power domain - USB PHY reset bit in SRC needs to be clear before doing USB PHY power gating in GPC, only needs to do once; - Need to handle GPC_PU_PWRHSK during power up/down; - Enable GPC pu power gate support. Signed-off-by: Anson Huang --- plat/freescale/imx8mq/gpc.c | 31 +++++++++++++++++++++++++++++-- plat/freescale/imx8mq/imx8m_bl31_setup.c | 4 ---- 2 files changed, 29 insertions(+), 6 deletions(-) diff --git a/plat/freescale/imx8mq/gpc.c b/plat/freescale/imx8mq/gpc.c index 26755c0a..b3ddd770 100644 --- a/plat/freescale/imx8mq/gpc.c +++ b/plat/freescale/imx8mq/gpc.c @@ -443,8 +443,6 @@ static void imx_gpc_pm_domain_enable(uint32_t domain_id, uint32_t on) uint32_t val; uintptr_t reg; - return; - /* * PCIE1 and PCIE2 share the same reset signal, if we power down * PCIE2, PCIE1 will be hold in reset too. @@ -463,6 +461,23 @@ static void imx_gpc_pm_domain_enable(uint32_t domain_id, uint32_t on) if (domain_id == 10 && !on && !is_pcie1_power_down) return; + /* need to handle GPC_PU_PWRHSK */ + /* GPU */ + if (domain_id == 4 && !on) + mmio_write_32(0x303a01fc, mmio_read_32(0x303a01fc) & ~0x40); + if (domain_id == 4 && on) + mmio_write_32(0x303a01fc, mmio_read_32(0x303a01fc) | 0x40); + /* VPU */ + if (domain_id == 5 && !on) + mmio_write_32(0x303a01fc, mmio_read_32(0x303a01fc) & ~0x20); + if (domain_id == 5 && on) + mmio_write_32(0x303a01fc, mmio_read_32(0x303a01fc) | 0x20); + /* DISPLAY */ + if (domain_id == 7 && !on) + mmio_write_32(0x303a01fc, mmio_read_32(0x303a01fc) & ~0x10); + if (domain_id == 7 && on) + mmio_write_32(0x303a01fc, mmio_read_32(0x303a01fc) | 0x10); + imx_gpc_set_m_core_pgc(gpc_pu_m_core_offset[domain_id], true); reg = IMX_GPC_BASE + (on ? 0xf8 : 0x104); @@ -524,6 +539,18 @@ void imx_gpc_init(void) val &= ~(1 << 31); /* TODO if M4 is not enabled, clear more SLPCR bits */ mmio_write_32(IMX_GPC_BASE + GPC_SLPCR, val); + + /* + * USB PHY power up needs to make sure RESET bit in SRC is clear, + * otherwise, the PU power up bit in GPC will NOT self-cleared. + * only need to do it once. + */ + val = mmio_read_32(0x30390020); + val &= ~0x1; + mmio_write_32(0x30390020, val); + val = mmio_read_32(0x30390024); + val &= ~0x1; + mmio_write_32(0x30390024, val); } int imx_gpc_handler(uint32_t smc_fid, diff --git a/plat/freescale/imx8mq/imx8m_bl31_setup.c b/plat/freescale/imx8mq/imx8m_bl31_setup.c index 21b7fdf9..132deb37 100644 --- a/plat/freescale/imx8mq/imx8m_bl31_setup.c +++ b/plat/freescale/imx8mq/imx8m_bl31_setup.c @@ -177,10 +177,6 @@ void bl31_early_platform_setup(bl31_params_t *from_bl2, mmio_write_32(0x32df004c, 0x0); mmio_write_32(0x32df0050, 0x0); - mmio_write_32(0x303a00ec, 0x0000ffff); - /* Power up VPU, DISP, GPU etc */ - mmio_write_32(0x303a00f8, 0x3fef); - #if DEBUG_CONSOLE console_init(IMX_BOOT_UART_BASE, IMX_BOOT_UART_CLK_IN_HZ, IMX_CONSOLE_BAUDRATE); -- cgit v1.2.3