imx: imx9: disable watchdog

Disable all 3 wdogs on AIPS2 and unmask SRC reset trigger for WDOG3-5

Signed-off-by: Ye Li <ye.li@nxp.com>
Signed-off-by: Peng Fan <peng.fan@nxp.com>

diff --git a/arch/arm/include/asm/arch-imx9/imx-regs.h b/arch/arm/include/asm/arch-imx9/imx-regs.h
index 32c76ce9c3bfd4980dd01efb5a8e8de3ea5aae3e..e4babed40fcafd009e80ab44e0a7b417c78f442c 100644 (file)
--- a/arch/arm/include/asm/arch-imx9/imx-regs.h
+++ b/arch/arm/include/asm/arch-imx9/imx-regs.h
@@ -15,4 +15,8 @@
 
 #define ANATOP_BASE_ADDR    0x44480000UL
 
+#define WDG3_BASE_ADDR      0x42490000UL
+#define WDG4_BASE_ADDR      0x424a0000UL
+#define WDG5_BASE_ADDR      0x424b0000UL
+
 #endif

diff --git a/arch/arm/mach-imx/imx9/soc.c b/arch/arm/mach-imx/imx9/soc.c
index 4b8f1ca30d55855b4785aadf51c3eda0cc01eecd..8b620832b5dd89982b327d9c8b48a989b67b12e1 100644 (file)
--- a/arch/arm/mach-imx/imx9/soc.c
+++ b/arch/arm/mach-imx/imx9/soc.c
@@ -34,6 +34,45 @@ u32 get_cpu_rev(void)
        return (MXC_CPU_IMX93 << 12) | CHIP_REV_1_0;
 }
 
+#define UNLOCK_WORD 0xD928C520 /* unlock word */
+#define REFRESH_WORD 0xB480A602 /* refresh word */
+
+static void disable_wdog(void __iomem *wdog_base)
+{
+       u32 val_cs = readl(wdog_base + 0x00);
+
+       if (!(val_cs & 0x80))
+               return;
+
+       /* default is 32bits cmd */
+       writel(REFRESH_WORD, (wdog_base + 0x04)); /* Refresh the CNT */
+
+       if (!(val_cs & 0x800)) {
+               writel(UNLOCK_WORD, (wdog_base + 0x04));
+               while (!(readl(wdog_base + 0x00) & 0x800))
+                       ;
+       }
+       writel(0x0, (wdog_base + 0x0C)); /* Set WIN to 0 */
+       writel(0x400, (wdog_base + 0x08)); /* Set timeout to default 0x400 */
+       writel(0x2120, (wdog_base + 0x00)); /* Disable it and set update */
+
+       while (!(readl(wdog_base + 0x00) & 0x400))
+               ;
+}
+
+void init_wdog(void)
+{
+       u32 src_val;
+
+       disable_wdog((void __iomem *)WDG3_BASE_ADDR);
+       disable_wdog((void __iomem *)WDG4_BASE_ADDR);
+       disable_wdog((void __iomem *)WDG5_BASE_ADDR);
+
+       src_val = readl(0x54460018); /* reset mask */
+       src_val &= ~0x1c;
+       writel(src_val, 0x54460018);
+}
+
 static struct mm_region imx93_mem_map[] = {
        {
                /* ROM */
@@ -123,8 +162,12 @@ int ft_system_setup(void *blob, struct bd_info *bd)
 
 int arch_cpu_init(void)
 {
-       if (IS_ENABLED(CONFIG_SPL_BUILD))
+       if (IS_ENABLED(CONFIG_SPL_BUILD)) {
+               /* Disable wdog */
+               init_wdog();
+
                clock_init();
+       }
 
        return 0;
 }