LF-13233 feat(imx95): support setting M7 reset address

Add operation for setting M7 core reset address via SMC. x2 holds the value of the reset address, while x3 holds a flag indicating which reset address to set (boot, start, or resume). Change-Id: I064952769b7dae7193c71f355f3b2689e16ab1ec Signed-off-by: Laurentiu Mihalcea <[email protected]> Reviewed-by: Peng Fan <[email protected]>
nxp-qoriq · Sep 30, 2024 · 7f72130 · 7f72130
1 parent 7c4a94d
commit 7f72130
Show file tree

Hide file tree

Showing 2 changed files with 9 additions and 0 deletions.
diff --git a/plat/imx/common/include/imx_sip_svc.h b/plat/imx/common/include/imx_sip_svc.h
@@ -32,6 +32,7 @@
 #define IMX_SIP_SRC_M4_START		0x00
 #define IMX_SIP_SRC_M4_STARTED		0x01
 #define IMX_SIP_SRC_M4_STOP		0x02
+#define IMX_SIP_SRC_M4_RESET_ADDR_SET	0x03
 #define IMX_SIP_SRC_SET_SECONDARY_BOOT	0x10
 #define IMX_SIP_SRC_IS_SECONDARY_BOOT	0x11
 

diff --git a/plat/imx/imx95/imx95_m7.c b/plat/imx/imx95/imx95_m7.c
@@ -50,6 +50,14 @@ int imx_src_handler(uint32_t smc_fid, u_register_t x1, u_register_t x2,
 	}
 
 	switch(x1) {
+	case IMX_SIP_SRC_M4_RESET_ADDR_SET:
+		ret = scmi_core_set_reset_addr(imx95_scmi_handle, x2,
+					       IMX9_SCMI_CPU_M7P,
+					       x3);
+		if (ret)
+			return ret;
+
+		break;
 	case IMX_SIP_SRC_M4_START:
 		ret = scmi_core_set_reset_addr(imx95_scmi_handle, x2,
 					       IMX9_SCMI_CPU_M7P,