1*83d290c5STom Rini // SPDX-License-Identifier: GPL-2.0+ 2214ffae0SHongbo Zhang /* 3214ffae0SHongbo Zhang * Copyright 2016 Freescale Semiconductor, Inc. 4214ffae0SHongbo Zhang * Author: Hongbo Zhang <hongbo.zhang@nxp.com> 5214ffae0SHongbo Zhang * This file implements LS102X platform PSCI SYSTEM-SUSPEND function 6214ffae0SHongbo Zhang */ 7214ffae0SHongbo Zhang 8214ffae0SHongbo Zhang #include <config.h> 9214ffae0SHongbo Zhang #include <asm/io.h> 10214ffae0SHongbo Zhang #include <asm/psci.h> 11214ffae0SHongbo Zhang #include <asm/arch/immap_ls102xa.h> 12214ffae0SHongbo Zhang #include <fsl_immap.h> 13214ffae0SHongbo Zhang #include "fsl_epu.h" 14214ffae0SHongbo Zhang 15214ffae0SHongbo Zhang #define __secure __attribute__((section("._secure.text"))) 16214ffae0SHongbo Zhang 17214ffae0SHongbo Zhang #define CCSR_GICD_CTLR 0x1000 18214ffae0SHongbo Zhang #define CCSR_GICC_CTLR 0x2000 19214ffae0SHongbo Zhang #define DCSR_RCPM_CG1CR0 0x31c 20214ffae0SHongbo Zhang #define DCSR_RCPM_CSTTACR0 0xb00 21214ffae0SHongbo Zhang #define DCFG_CRSTSR_WDRFR 0x8 22214ffae0SHongbo Zhang #define DDR_RESV_LEN 128 23214ffae0SHongbo Zhang 24214ffae0SHongbo Zhang #ifdef CONFIG_LS1_DEEP_SLEEP 25214ffae0SHongbo Zhang /* 26214ffae0SHongbo Zhang * DDR controller initialization training breaks the first 128 bytes of DDR, 27214ffae0SHongbo Zhang * save them so that the bootloader can restore them while resuming. 28214ffae0SHongbo Zhang */ 29214ffae0SHongbo Zhang static void __secure ls1_save_ddr_head(void) 30214ffae0SHongbo Zhang { 31214ffae0SHongbo Zhang const char *src = (const char *)CONFIG_SYS_SDRAM_BASE; 32214ffae0SHongbo Zhang char *dest = (char *)(OCRAM_BASE_S_ADDR + OCRAM_S_SIZE - DDR_RESV_LEN); 33214ffae0SHongbo Zhang struct ccsr_scfg __iomem *scfg = (void *)CONFIG_SYS_FSL_SCFG_ADDR; 34214ffae0SHongbo Zhang int i; 35214ffae0SHongbo Zhang 36214ffae0SHongbo Zhang out_le32(&scfg->sparecr[2], dest); 37214ffae0SHongbo Zhang 38214ffae0SHongbo Zhang for (i = 0; i < DDR_RESV_LEN; i++) 39214ffae0SHongbo Zhang *dest++ = *src++; 40214ffae0SHongbo Zhang } 41214ffae0SHongbo Zhang 42214ffae0SHongbo Zhang static void __secure ls1_fsm_setup(void) 43214ffae0SHongbo Zhang { 44214ffae0SHongbo Zhang void *dcsr_epu_base = (void *)(CONFIG_SYS_DCSRBAR + EPU_BLOCK_OFFSET); 45295a24b3SYork Sun void *dcsr_rcpm_base = (void *)SYS_FSL_DCSR_RCPM_ADDR; 46214ffae0SHongbo Zhang 47214ffae0SHongbo Zhang out_be32(dcsr_rcpm_base + DCSR_RCPM_CSTTACR0, 0x00001001); 48214ffae0SHongbo Zhang out_be32(dcsr_rcpm_base + DCSR_RCPM_CG1CR0, 0x00000001); 49214ffae0SHongbo Zhang 50214ffae0SHongbo Zhang fsl_epu_setup((void *)dcsr_epu_base); 51214ffae0SHongbo Zhang 52214ffae0SHongbo Zhang /* Pull MCKE signal low before enabling deep sleep signal in FPGA */ 53214ffae0SHongbo Zhang out_be32(dcsr_epu_base + EPECR0, 0x5); 54214ffae0SHongbo Zhang out_be32(dcsr_epu_base + EPSMCR15, 0x76300000); 55214ffae0SHongbo Zhang } 56214ffae0SHongbo Zhang 57214ffae0SHongbo Zhang static void __secure ls1_deepsleep_irq_cfg(void) 58214ffae0SHongbo Zhang { 59214ffae0SHongbo Zhang struct ccsr_scfg __iomem *scfg = (void *)CONFIG_SYS_FSL_SCFG_ADDR; 60214ffae0SHongbo Zhang struct ccsr_rcpm __iomem *rcpm = (void *)CONFIG_SYS_FSL_RCPM_ADDR; 61214ffae0SHongbo Zhang u32 ippdexpcr0, ippdexpcr1, pmcintecr = 0; 62214ffae0SHongbo Zhang 63214ffae0SHongbo Zhang /* Mask interrupts from GIC */ 64214ffae0SHongbo Zhang out_be32(&rcpm->nfiqoutr, 0x0ffffffff); 65214ffae0SHongbo Zhang out_be32(&rcpm->nirqoutr, 0x0ffffffff); 66214ffae0SHongbo Zhang /* Mask deep sleep wake-up interrupts while entering deep sleep */ 67214ffae0SHongbo Zhang out_be32(&rcpm->dsimskr, 0x0ffffffff); 68214ffae0SHongbo Zhang 69214ffae0SHongbo Zhang ippdexpcr0 = in_be32(&rcpm->ippdexpcr0); 70214ffae0SHongbo Zhang /* 71214ffae0SHongbo Zhang * Workaround: There is bug of register ippdexpcr1, when read it always 72214ffae0SHongbo Zhang * returns zero, so its value is saved to a scrachpad register to be 73214ffae0SHongbo Zhang * read, that is why we don't read it from register ippdexpcr1 itself. 74214ffae0SHongbo Zhang */ 75214ffae0SHongbo Zhang ippdexpcr1 = in_le32(&scfg->sparecr[7]); 76214ffae0SHongbo Zhang 77214ffae0SHongbo Zhang if (ippdexpcr0 & RCPM_IPPDEXPCR0_ETSEC) 78214ffae0SHongbo Zhang pmcintecr |= SCFG_PMCINTECR_ETSECRXG0 | 79214ffae0SHongbo Zhang SCFG_PMCINTECR_ETSECRXG1 | 80214ffae0SHongbo Zhang SCFG_PMCINTECR_ETSECERRG0 | 81214ffae0SHongbo Zhang SCFG_PMCINTECR_ETSECERRG1; 82214ffae0SHongbo Zhang 83214ffae0SHongbo Zhang if (ippdexpcr0 & RCPM_IPPDEXPCR0_GPIO) 84214ffae0SHongbo Zhang pmcintecr |= SCFG_PMCINTECR_GPIO; 85214ffae0SHongbo Zhang 86214ffae0SHongbo Zhang if (ippdexpcr1 & RCPM_IPPDEXPCR1_LPUART) 87214ffae0SHongbo Zhang pmcintecr |= SCFG_PMCINTECR_LPUART; 88214ffae0SHongbo Zhang 89214ffae0SHongbo Zhang if (ippdexpcr1 & RCPM_IPPDEXPCR1_FLEXTIMER) 90214ffae0SHongbo Zhang pmcintecr |= SCFG_PMCINTECR_FTM; 91214ffae0SHongbo Zhang 92214ffae0SHongbo Zhang /* Always set external IRQ pins as wakeup source */ 93214ffae0SHongbo Zhang pmcintecr |= SCFG_PMCINTECR_IRQ0 | SCFG_PMCINTECR_IRQ1; 94214ffae0SHongbo Zhang 95214ffae0SHongbo Zhang out_be32(&scfg->pmcintlecr, 0); 96214ffae0SHongbo Zhang /* Clear PMC interrupt status */ 97214ffae0SHongbo Zhang out_be32(&scfg->pmcintsr, 0xffffffff); 98214ffae0SHongbo Zhang /* Enable wakeup interrupt during deep sleep */ 99214ffae0SHongbo Zhang out_be32(&scfg->pmcintecr, pmcintecr); 100214ffae0SHongbo Zhang } 101214ffae0SHongbo Zhang 102214ffae0SHongbo Zhang static void __secure ls1_delay(unsigned int loop) 103214ffae0SHongbo Zhang { 104214ffae0SHongbo Zhang while (loop--) { 105214ffae0SHongbo Zhang int i = 1000; 106214ffae0SHongbo Zhang while (i--) 107214ffae0SHongbo Zhang ; 108214ffae0SHongbo Zhang } 109214ffae0SHongbo Zhang } 110214ffae0SHongbo Zhang 111214ffae0SHongbo Zhang static void __secure ls1_start_fsm(void) 112214ffae0SHongbo Zhang { 113214ffae0SHongbo Zhang void *dcsr_epu_base = (void *)(CONFIG_SYS_DCSRBAR + EPU_BLOCK_OFFSET); 114295a24b3SYork Sun void *ccsr_gic_base = (void *)SYS_FSL_GIC_ADDR; 115214ffae0SHongbo Zhang struct ccsr_scfg __iomem *scfg = (void *)CONFIG_SYS_FSL_SCFG_ADDR; 116214ffae0SHongbo Zhang struct ccsr_ddr __iomem *ddr = (void *)CONFIG_SYS_FSL_DDR_ADDR; 117214ffae0SHongbo Zhang 118214ffae0SHongbo Zhang /* Set HRSTCR */ 119214ffae0SHongbo Zhang setbits_be32(&scfg->hrstcr, 0x80000000); 120214ffae0SHongbo Zhang 121214ffae0SHongbo Zhang /* Place DDR controller in self refresh mode */ 122214ffae0SHongbo Zhang setbits_be32(&ddr->sdram_cfg_2, 0x80000000); 123214ffae0SHongbo Zhang 124214ffae0SHongbo Zhang ls1_delay(2000); 125214ffae0SHongbo Zhang 126214ffae0SHongbo Zhang /* Set EVT4_B to lock the signal MCKE down */ 127214ffae0SHongbo Zhang out_be32(dcsr_epu_base + EPECR0, 0x0); 128214ffae0SHongbo Zhang 129214ffae0SHongbo Zhang ls1_delay(2000); 130214ffae0SHongbo Zhang 131214ffae0SHongbo Zhang out_be32(ccsr_gic_base + CCSR_GICD_CTLR, 0x0); 132214ffae0SHongbo Zhang out_be32(ccsr_gic_base + CCSR_GICC_CTLR, 0x0); 133214ffae0SHongbo Zhang 134214ffae0SHongbo Zhang /* Enable all EPU Counters */ 135214ffae0SHongbo Zhang setbits_be32(dcsr_epu_base + EPGCR, 0x80000000); 136214ffae0SHongbo Zhang 137214ffae0SHongbo Zhang /* Enable SCU15 */ 138214ffae0SHongbo Zhang setbits_be32(dcsr_epu_base + EPECR15, 0x90000004); 139214ffae0SHongbo Zhang 140214ffae0SHongbo Zhang /* Enter WFI mode, and EPU FSM will start */ 141214ffae0SHongbo Zhang __asm__ __volatile__ ("wfi" : : : "memory"); 142214ffae0SHongbo Zhang 143214ffae0SHongbo Zhang /* NEVER ENTER HERE */ 144214ffae0SHongbo Zhang while (1) 145214ffae0SHongbo Zhang ; 146214ffae0SHongbo Zhang } 147214ffae0SHongbo Zhang 148214ffae0SHongbo Zhang static void __secure ls1_deep_sleep(u32 entry_point) 149214ffae0SHongbo Zhang { 150214ffae0SHongbo Zhang struct ccsr_scfg __iomem *scfg = (void *)CONFIG_SYS_FSL_SCFG_ADDR; 151214ffae0SHongbo Zhang struct ccsr_gur __iomem *gur = (void *)CONFIG_SYS_FSL_GUTS_ADDR; 152214ffae0SHongbo Zhang struct ccsr_rcpm __iomem *rcpm = (void *)CONFIG_SYS_FSL_RCPM_ADDR; 153214ffae0SHongbo Zhang #ifdef QIXIS_BASE 154214ffae0SHongbo Zhang u32 tmp; 155214ffae0SHongbo Zhang void *qixis_base = (void *)QIXIS_BASE; 156214ffae0SHongbo Zhang #endif 157214ffae0SHongbo Zhang 158214ffae0SHongbo Zhang /* Enable cluster to enter the PCL10 state */ 159214ffae0SHongbo Zhang out_be32(&scfg->clusterpmcr, SCFG_CLUSTERPMCR_WFIL2EN); 160214ffae0SHongbo Zhang 161214ffae0SHongbo Zhang /* Save the first 128 bytes of DDR data */ 162214ffae0SHongbo Zhang ls1_save_ddr_head(); 163214ffae0SHongbo Zhang 164214ffae0SHongbo Zhang /* Save the kernel resume entry */ 165214ffae0SHongbo Zhang out_le32(&scfg->sparecr[3], entry_point); 166214ffae0SHongbo Zhang 167214ffae0SHongbo Zhang /* Request to put cluster 0 in PCL10 state */ 168214ffae0SHongbo Zhang setbits_be32(&rcpm->clpcl10setr, RCPM_CLPCL10SETR_C0); 169214ffae0SHongbo Zhang 170214ffae0SHongbo Zhang /* Setup the registers of the EPU FSM for deep sleep */ 171214ffae0SHongbo Zhang ls1_fsm_setup(); 172214ffae0SHongbo Zhang 173214ffae0SHongbo Zhang #ifdef QIXIS_BASE 174214ffae0SHongbo Zhang /* Connect the EVENT button to IRQ in FPGA */ 175214ffae0SHongbo Zhang tmp = in_8(qixis_base + QIXIS_CTL_SYS); 176214ffae0SHongbo Zhang tmp &= ~QIXIS_CTL_SYS_EVTSW_MASK; 177214ffae0SHongbo Zhang tmp |= QIXIS_CTL_SYS_EVTSW_IRQ; 178214ffae0SHongbo Zhang out_8(qixis_base + QIXIS_CTL_SYS, tmp); 179214ffae0SHongbo Zhang 180214ffae0SHongbo Zhang /* Enable deep sleep signals in FPGA */ 181214ffae0SHongbo Zhang tmp = in_8(qixis_base + QIXIS_PWR_CTL2); 182214ffae0SHongbo Zhang tmp |= QIXIS_PWR_CTL2_PCTL; 183214ffae0SHongbo Zhang out_8(qixis_base + QIXIS_PWR_CTL2, tmp); 184214ffae0SHongbo Zhang 185214ffae0SHongbo Zhang /* Pull down PCIe RST# */ 186214ffae0SHongbo Zhang tmp = in_8(qixis_base + QIXIS_RST_FORCE_3); 187214ffae0SHongbo Zhang tmp |= QIXIS_RST_FORCE_3_PCIESLOT1; 188214ffae0SHongbo Zhang out_8(qixis_base + QIXIS_RST_FORCE_3, tmp); 189214ffae0SHongbo Zhang #endif 190214ffae0SHongbo Zhang 191214ffae0SHongbo Zhang /* Enable Warm Device Reset */ 192214ffae0SHongbo Zhang setbits_be32(&scfg->dpslpcr, SCFG_DPSLPCR_WDRR_EN); 193214ffae0SHongbo Zhang setbits_be32(&gur->crstsr, DCFG_CRSTSR_WDRFR); 194214ffae0SHongbo Zhang 195214ffae0SHongbo Zhang ls1_deepsleep_irq_cfg(); 196214ffae0SHongbo Zhang 197214ffae0SHongbo Zhang psci_v7_flush_dcache_all(); 198214ffae0SHongbo Zhang 199214ffae0SHongbo Zhang ls1_start_fsm(); 200214ffae0SHongbo Zhang } 201214ffae0SHongbo Zhang 202214ffae0SHongbo Zhang #else 203214ffae0SHongbo Zhang static void __secure ls1_sleep(void) 204214ffae0SHongbo Zhang { 205214ffae0SHongbo Zhang struct ccsr_scfg __iomem *scfg = (void *)CONFIG_SYS_FSL_SCFG_ADDR; 206214ffae0SHongbo Zhang struct ccsr_rcpm __iomem *rcpm = (void *)CONFIG_SYS_FSL_RCPM_ADDR; 207214ffae0SHongbo Zhang 208214ffae0SHongbo Zhang #ifdef QIXIS_BASE 209214ffae0SHongbo Zhang u32 tmp; 210214ffae0SHongbo Zhang void *qixis_base = (void *)QIXIS_BASE; 211214ffae0SHongbo Zhang 212214ffae0SHongbo Zhang /* Connect the EVENT button to IRQ in FPGA */ 213214ffae0SHongbo Zhang tmp = in_8(qixis_base + QIXIS_CTL_SYS); 214214ffae0SHongbo Zhang tmp &= ~QIXIS_CTL_SYS_EVTSW_MASK; 215214ffae0SHongbo Zhang tmp |= QIXIS_CTL_SYS_EVTSW_IRQ; 216214ffae0SHongbo Zhang out_8(qixis_base + QIXIS_CTL_SYS, tmp); 217214ffae0SHongbo Zhang #endif 218214ffae0SHongbo Zhang 219214ffae0SHongbo Zhang /* Enable cluster to enter the PCL10 state */ 220214ffae0SHongbo Zhang out_be32(&scfg->clusterpmcr, SCFG_CLUSTERPMCR_WFIL2EN); 221214ffae0SHongbo Zhang 222214ffae0SHongbo Zhang setbits_be32(&rcpm->powmgtcsr, RCPM_POWMGTCSR_LPM20_REQ); 223214ffae0SHongbo Zhang 224214ffae0SHongbo Zhang __asm__ __volatile__ ("wfi" : : : "memory"); 225214ffae0SHongbo Zhang } 226214ffae0SHongbo Zhang #endif 227214ffae0SHongbo Zhang 228214ffae0SHongbo Zhang void __secure ls1_system_suspend(u32 fn, u32 entry_point, u32 context_id) 229214ffae0SHongbo Zhang { 230214ffae0SHongbo Zhang #ifdef CONFIG_LS1_DEEP_SLEEP 231214ffae0SHongbo Zhang ls1_deep_sleep(entry_point); 232214ffae0SHongbo Zhang #else 233214ffae0SHongbo Zhang ls1_sleep(); 234214ffae0SHongbo Zhang #endif 235214ffae0SHongbo Zhang } 236