From: Abhash Kumar Jha <[email protected]>

When resuming from IO_ONLY_PLUS_DDR low power mode, the IOs are
isolated. Remove that isolation in resume sequence.

On j7200, The canuart IOs are isolated whereas on j784s4, the
mcu_general IOs are isolated.

Signed-off-by: Abhash Kumar Jha <[email protected]>
Co-developed-by: Richard Genoud (TI) <[email protected]>
Signed-off-by: Richard Genoud (TI) <[email protected]>
---
 .../arm/mach-k3/include/mach/j721e_hardware.h | 11 ++++++++
 .../mach-k3/include/mach/j784s4_hardware.h    | 10 ++++++++
 arch/arm/mach-k3/r5/lpm-common.c              | 15 +++++++++++
 board/ti/j721e/evm.c                          | 25 +++++++++++++++++++
 board/ti/j784s4/evm.c                         | 24 ++++++++++++++++++
 5 files changed, 85 insertions(+)

diff --git a/arch/arm/mach-k3/include/mach/j721e_hardware.h 
b/arch/arm/mach-k3/include/mach/j721e_hardware.h
index 5bef309af0a4..e6e437af4ec0 100644
--- a/arch/arm/mach-k3/include/mach/j721e_hardware.h
+++ b/arch/arm/mach-k3/include/mach/j721e_hardware.h
@@ -14,6 +14,17 @@
 #define WKUP_CTRL_MMR0_BASE                            0x43000000
 #define MCU_CTRL_MMR0_BASE                             0x40f00000
 #define CTRL_MMR0_BASE                                 0x00100000
+#define DMSC_PWRCTRL_BASE                              0x44130000
+
+#define PMCTRL_IO_1                                    (DMSC_PWRCTRL_BASE + 
0x88)
+#define PMCTRL_IO_LPM                                  PMCTRL_IO_1
+#define CANUART_WAKE_CTRL                              0x18300
+#define CANUART_WAKE_STAT0                             0x18308
+#define CANUART_WAKE_STAT1                             0x1830C
+
+#define IO_ISO_MAGIC_VAL                               0x55555554
+#define CANUART_WAKE_STAT1_CANUART_IO_MODE             BIT(0)
+#define DEISOLATION_TIMEOUT_MS                         10
 
 #define CTRLMMR_MAIN_DEVSTAT                           (CTRL_MMR0_BASE + 0x30)
 #define MAIN_DEVSTAT_BOOT_MODE_B_MASK          BIT(0)
diff --git a/arch/arm/mach-k3/include/mach/j784s4_hardware.h 
b/arch/arm/mach-k3/include/mach/j784s4_hardware.h
index 29a894baed34..033ae153d674 100644
--- a/arch/arm/mach-k3/include/mach/j784s4_hardware.h
+++ b/arch/arm/mach-k3/include/mach/j784s4_hardware.h
@@ -15,6 +15,16 @@
 #define MCU_CTRL_MMR0_BASE                             0x40f00000
 #define CTRL_MMR0_BASE                                 0x00100000
 
+#define PMCTRL_IO_0                                    (WKUP_CTRL_MMR0_BASE + 
0x14084)
+#define PMCTRL_IO_LPM                                  PMCTRL_IO_0
+#define MCU_GEN_WAKE_CTRL                              0x18310
+#define MCU_GEN_WAKE_STAT0                             0x18318
+#define MCU_GEN_WAKE_STAT1                             0x1831C
+
+#define IO_ISO_MAGIC_VAL                               0x55555554
+#define MCU_GEN_WAKE_STAT1_MCU_GEN_IO_MODE             BIT(0)
+#define DEISOLATION_TIMEOUT_MS                         10
+
 #define CTRLMMR_MAIN_DEVSTAT                           (CTRL_MMR0_BASE + 0x30)
 #define MAIN_DEVSTAT_BOOT_MODE_B_MASK                  BIT(0)
 #define MAIN_DEVSTAT_BOOT_MODE_B_SHIFT                 0
diff --git a/arch/arm/mach-k3/r5/lpm-common.c b/arch/arm/mach-k3/r5/lpm-common.c
index 9f14d5029bf0..1b3660f8243b 100644
--- a/arch/arm/mach-k3/r5/lpm-common.c
+++ b/arch/arm/mach-k3/r5/lpm-common.c
@@ -6,6 +6,7 @@
  * Copyright (C) 2026 Bootlin
  */
 
+#include <asm/arch/hardware.h>
 #include <asm/global_data.h>
 #include <clk.h>
 #include <dm/device.h>
@@ -28,6 +29,7 @@
 /* PMIC register where the magic value resides */
 #define K3_LPM_SCRATCH_PAD_REG_3 0xcb
 
+#define IO_ISO_STATUS BIT(25)
 #define FW_IMAGE_SIZE 0x80000
 
 struct lpm_addr_info {
@@ -38,6 +40,8 @@ struct lpm_addr_info {
        u32 size;
 };
 
+__weak void clear_isolation(void) { }
+
 /* This is used by J722s */
 __weak void ctrl_mmr_unlock(void) { }
 
@@ -45,11 +49,22 @@ __weak void ctrl_mmr_unlock(void) { }
 bool j7xx_board_is_resuming(void)
 {
        struct udevice *pmic, *i2c;
+       u32 pmctrl_val = 0;
        int ret;
 
        if (gd_k3_resuming() != K3_RESUME_STATE_UNKNOWN)
                goto end;
 
+#ifdef PMCTRL_IO_LPM
+       pmctrl_val = readl(PMCTRL_IO_LPM);
+#endif
+       if ((pmctrl_val & IO_ISO_STATUS) == IO_ISO_STATUS) {
+               clear_isolation();
+               gd_set_k3_resuming(K3_RESUME_STATE_RESUMING);
+               debug("board is resuming from IO_DDR mode\n");
+               goto end;
+       }
+
        if (IS_ENABLED(CONFIG_SOC_K3_J722S)) {
                /*
                 * On J722S devices, i2c access fails unless MMR
diff --git a/board/ti/j721e/evm.c b/board/ti/j721e/evm.c
index 881392bd963a..2fba16fda323 100644
--- a/board/ti/j721e/evm.c
+++ b/board/ti/j721e/evm.c
@@ -17,6 +17,7 @@
 #include <spl.h>
 #include <dm.h>
 #include <asm/arch/k3-ddr.h>
+#include <wait_bit.h>
 
 #include "../common/board_detect.h"
 #include "../common/fdt_ops.h"
@@ -469,6 +470,30 @@ err_free_gpio:
        }
 }
 
+#if (IS_ENABLED(CONFIG_SPL_BUILD) && IS_ENABLED(CONFIG_TARGET_J7200_R5_EVM))
+
+void clear_isolation(void)
+{
+       int ret;
+       const void *wait_reg = (const void *)(WKUP_CTRL_MMR0_BASE + 
CANUART_WAKE_STAT1);
+
+       /* un-set the magic word for canuart IOs */
+       writel(IO_ISO_MAGIC_VAL, WKUP_CTRL_MMR0_BASE + CANUART_WAKE_CTRL);
+       writel((IO_ISO_MAGIC_VAL + 0x1), WKUP_CTRL_MMR0_BASE + 
CANUART_WAKE_CTRL);
+       writel(IO_ISO_MAGIC_VAL, WKUP_CTRL_MMR0_BASE + CANUART_WAKE_CTRL);
+
+       /* wait for CANUART_IO_MODE bit to be cleared */
+       ret = wait_for_bit_32(wait_reg,
+                             CANUART_WAKE_STAT1_CANUART_IO_MODE,
+                             false,
+                             DEISOLATION_TIMEOUT_MS,
+                             false);
+       if (ret < 0)
+               pr_err("Deisolation timeout");
+}
+
+#endif /* CONFIG_SPL_BUILD && CONFIG_TARGET_J7200_R5_EVM */
+
 void spl_board_init(void)
 {
        struct udevice *dev;
diff --git a/board/ti/j784s4/evm.c b/board/ti/j784s4/evm.c
index cabb3017ee14..73730ca94438 100644
--- a/board/ti/j784s4/evm.c
+++ b/board/ti/j784s4/evm.c
@@ -11,7 +11,9 @@
 #include <efi_loader.h>
 #include <init.h>
 #include <spl.h>
+#include <asm/arch/hardware.h>
 #include <asm/arch/k3-ddr.h>
+#include <wait_bit.h>
 #include "../common/fdt_ops.h"
 
 DECLARE_GLOBAL_DATA_PTR;
@@ -61,6 +63,28 @@ int board_late_init(void)
 }
 #endif
 
+#if (IS_ENABLED(CONFIG_SPL_BUILD) && IS_ENABLED(CONFIG_TARGET_J784S4_R5_EVM))
+void clear_isolation(void)
+{
+       int ret;
+       const void *wait_reg = (const void *)(WKUP_CTRL_MMR0_BASE + 
MCU_GEN_WAKE_STAT1);
+
+       /* un-set the magic word for MCU_GENERAL IOs */
+       writel(IO_ISO_MAGIC_VAL, WKUP_CTRL_MMR0_BASE + MCU_GEN_WAKE_CTRL);
+       writel((IO_ISO_MAGIC_VAL + 0x1), WKUP_CTRL_MMR0_BASE + 
MCU_GEN_WAKE_CTRL);
+       writel(IO_ISO_MAGIC_VAL, WKUP_CTRL_MMR0_BASE + MCU_GEN_WAKE_CTRL);
+
+       /* wait for MCU_GEN_IO_MODE bit to be cleared */
+       ret = wait_for_bit_32(wait_reg,
+                             MCU_GEN_WAKE_STAT1_MCU_GEN_IO_MODE,
+                             false,
+                             DEISOLATION_TIMEOUT_MS,
+                             false);
+       if (ret < 0)
+               pr_err("Deisolation timeout");
+}
+#endif /* CONFIG_SPL_BUILD && CONFIG_TARGET_J784s4_R5_EVM */
+
 void spl_board_init(void)
 {
        struct udevice *dev;
-- 
2.47.3

Reply via email to