freescale: add srtc SIP support

Add SRTC SIP support for i.MX8QM/i.MX8QXP.

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

5 files changed, 77 insertions, 0 deletions

diff --git a/plat/freescale/common/include/fsl_sip.h b/plat/freescale/common/include/fsl_sip.h
index 52dceb81..3449944d 100644
--- a/plat/freescale/common/include/fsl_sip.h
+++ b/plat/freescale/common/include/fsl_sip.h
@@ -24,5 +24,7 @@
 #define FSL_SIP_CPUFREQ			0xC2000001
 #define FSL_SIP_SET_CPUFREQ		0x00
 
+#define FSL_SIP_SRTC			0xC2000002
+#define FSL_SIP_SRTC_SET_TIME		0x00
 
 #endif
diff --git a/plat/freescale/common/sip_svc.c b/plat/freescale/common/sip_svc.c
index d8c1c5bf..960245da 100644
--- a/plat/freescale/common/sip_svc.c
+++ b/plat/freescale/common/sip_svc.c
@@ -39,6 +39,8 @@
 
 extern int imx_gpc_handler(uint32_t  smc_fid, u_register_t x1, u_register_t x2, u_register_t x3);
 extern int imx_cpufreq_handler(uint32_t  smc_fid, u_register_t x1, u_register_t x2, u_register_t x3);
+extern int imx_srtc_handler(uint32_t smc_fid, u_register_t x1,
+	u_register_t x2, u_register_t x3, u_register_t x4);
 
 /* Setup i.MX platform specific services Services */
 static int32_t plat_svc_setup(void)
@@ -69,6 +71,9 @@ uintptr_t imx_svc_smc_handler(uint32_t smc_fid,
 	case  FSL_SIP_CPUFREQ:
 		SMC_RET1(handle, imx_cpufreq_handler(smc_fid, x1, x2, x3));
 		break;
+	case  FSL_SIP_SRTC:
+		SMC_RET1(handle, imx_srtc_handler(smc_fid, x1, x2, x3, x4));
+		break;
 #endif
 	default:
 		WARN("Unimplemented SIP Service Call: 0x%x \n", smc_fid);
diff --git a/plat/freescale/common/srtc.c b/plat/freescale/common/srtc.c
new file mode 100644
index 00000000..0a32d65b
--- /dev/null
+++ b/plat/freescale/common/srtc.c
@@ -0,0 +1,68 @@
+/*
+ * Copyright 2017 NXP
+ *
+ * Redistribution and use in source and binary forms, with or without
+ * modification, are permitted provided that the following conditions are met:
+ *
+ * Redistributions of source code must retain the above copyright notice, this
+ * list of conditions and the following disclaimer.
+ *
+ * Redistributions in binary form must reproduce the above copyright notice,
+ * this list of conditions and the following disclaimer in the documentation
+ * and/or other materials provided with the distribution.
+ *
+ * Neither the name of NXP nor the names of its contributors may be used
+ * to endorse or promote products derived from this software without specific
+ * prior written permission.
+ *
+ * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS IS"
+ * AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
+ * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
+ * ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT HOLDER OR CONTRIBUTORS BE
+ * LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
+ * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
+ * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
+ * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
+ * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
+ * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
+ * POSSIBILITY OF SUCH DAMAGE.
+ */
+
+#include <debug.h>
+#include <stdlib.h>
+#include <stdint.h>
+#include <smcc_helpers.h>
+#include <std_svc.h>
+#include <types.h>
+#include <platform_def.h>
+#include <fsl_sip.h>
+#include <sci/sci.h>
+
+extern sc_ipc_t ipc_handle;
+
+static int imx_srtc_set_time(uint32_t year_mon, unsigned long day_hour, unsigned long min_sec)
+{
+	return sc_timer_set_rtc_time(ipc_handle,
+		year_mon >> 16, year_mon & 0xffff,
+		day_hour >> 16, day_hour & 0xffff,
+		min_sec >> 16, min_sec & 0xffff);
+}
+
+int imx_srtc_handler(uint32_t smc_fid,
+		    u_register_t x1,
+		    u_register_t x2,
+		    u_register_t x3,
+		    u_register_t x4)
+{
+	int ret;
+
+	switch(x1) {
+	case FSL_SIP_SRTC_SET_TIME:
+		ret = imx_srtc_set_time(x2, x3, x4);
+		break;
+	default:
+		return SMC_UNK;
+	}
+
+	return ret;
+}
diff --git a/plat/freescale/imx8qm/platform.mk b/plat/freescale/imx8qm/platform.mk
index 8abc978d..8db7f192 100644
--- a/plat/freescale/imx8qm/platform.mk
+++ b/plat/freescale/imx8qm/platform.mk
@@ -42,6 +42,7 @@ BL31_SOURCES		+=	plat/freescale/common/lpuart_console.S		\
 				plat/freescale/common/imx8_helpers.S		\
 				plat/freescale/common/sip_svc.c			\
 				plat/freescale/common/cpufreq.c			\
+				plat/freescale/common/srtc.c			\
 				plat/freescale/imx8qm/imx8qm_bl31_setup.c	\
 				plat/freescale/imx8qm/imx8qm_psci.c		\
 				plat/freescale/common/imx8_topology.c		\
diff --git a/plat/freescale/imx8qxp/platform.mk b/plat/freescale/imx8qxp/platform.mk
index 9be92464..e25de57f 100644
--- a/plat/freescale/imx8qxp/platform.mk
+++ b/plat/freescale/imx8qxp/platform.mk
@@ -42,6 +42,7 @@ BL31_SOURCES		+=	plat/freescale/common/lpuart_console.S		\
 				plat/freescale/common/imx8_helpers.S		\
 				plat/freescale/common/sip_svc.c			\
 				plat/freescale/common/cpufreq.c			\
+				plat/freescale/common/srtc.c			\
 				plat/freescale/imx8qxp/imx8qxp_bl31_setup.c	\
 				plat/freescale/imx8qxp/imx8qxp_psci.c		\
 				plat/freescale/common/imx8_topology.c		\