imx: mx7: psci: add system reset support

Add i.MX7 PSCI system reset support, linux
kernel can use "reboot" command to reset
system even wdog driver is disabled in kernel.

Signed-off-by: Anson Huang <Anson.Huang@nxp.com>

diff --git a/arch/arm/mach-imx/mx7/psci-mx7.c b/arch/arm/mach-imx/mx7/psci-mx7.c
index 7f429b0a4332c3d21e15db3c72b434243f7a1384..b26be89c787b4f7578f416fb50f988cb291ddbfb 100644 (file)
--- a/arch/arm/mach-imx/mx7/psci-mx7.c
+++ b/arch/arm/mach-imx/mx7/psci-mx7.c
@@ -10,7 +10,7 @@
 #include <asm/secure.h>
 #include <asm/arch/imx-regs.h>
 #include <common.h>
-
+#include <fsl_wdog.h>
 
 #define GPC_CPU_PGC_SW_PDN_REQ 0xfc
 #define GPC_CPU_PGC_SW_PUP_REQ 0xf0
@@ -26,6 +26,9 @@
 #define BP_SRC_A7RCR0_A7_CORE_RESET0   0
 #define BP_SRC_A7RCR1_A7_CORE1_ENABLE  1
 
+#define CCM_ROOT_WDOG          0xbb80
+#define CCM_CCGR_WDOG1         0x49c0
+
 static inline void imx_gpcv2_set_m_core_pgc(bool enable, u32 offset)
 {
        writel(enable, GPC_IPS_BASE_ADDR + offset);
@@ -74,3 +77,13 @@ __secure int imx_cpu_off(int cpu)
        writel(0, SRC_BASE_ADDR + cpu * 8 + SRC_GPR1_MX7D + 4);
        return 0;
 }
+
+__secure void imx_system_reset(void)
+{
+       struct wdog_regs *wdog = (struct wdog_regs *)WDOG1_BASE_ADDR;
+
+       /* make sure WDOG1 clock is enabled */
+       writel(0x1 << 28, CCM_BASE_ADDR + CCM_ROOT_WDOG);
+       writel(0x3, CCM_BASE_ADDR + CCM_CCGR_WDOG1);
+       writew(WCR_WDE, &wdog->wcr);
+}

diff --git a/arch/arm/mach-imx/mx7/psci.S b/arch/arm/mach-imx/mx7/psci.S
index fc5eb34c8890a20271579953836020dae067884a..e23db24ee9589518e81eed47a79dd85086705d59 100644 (file)
--- a/arch/arm/mach-imx/mx7/psci.S
+++ b/arch/arm/mach-imx/mx7/psci.S
@@ -43,4 +43,11 @@ psci_cpu_off:
 1:     wfi
        b 1b
 
+.globl psci_system_reset
+psci_system_reset:
+       bl      imx_system_reset
+
+2:     wfi
+       b 2b
+
        .popsection