diff -drupN a/drivers/char/sunxi-sysinfo/sunxi-smc.c b/drivers/char/sunxi-sysinfo/sunxi-smc.c
--- a/drivers/char/sunxi-sysinfo/sunxi-smc.c	1970-01-01 03:00:00.000000000 +0300
+++ b/drivers/char/sunxi-sysinfo/sunxi-smc.c	2022-06-12 05:28:14.000000000 +0300
@@ -0,0 +1,159 @@
+/*
+ * Based on arch/arm64/kernel/chipid-sunxi.c
+ *
+ * Copyright (C) 2015 Allwinnertech Ltd.
+ *
+ * This program is free software; you can redistribute it and/or modify
+ * it under the terms of the GNU General Public License version 2 as
+ * published by the Free Software Foundation.
+ *
+ * This program is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program.  If not, see <http://www.gnu.org/licenses/>.
+ */
+#include <linux/io.h>
+#include <linux/kernel.h>
+#include <linux/sunxi-smc.h>
+#include <linux/sunxi-sid.h>
+#include <linux/arm-smccc.h>
+#include <linux/bitops.h>
+
+#ifndef OPTEE_SMC_STD_CALL_VAL
+#define OPTEE_SMC_STD_CALL_VAL(func_num) \
+	ARM_SMCCC_CALL_VAL(ARM_SMCCC_STD_CALL, ARM_SMCCC_SMC_32, \
+			   ARM_SMCCC_OWNER_TRUSTED_OS, (func_num))
+#endif
+
+#ifndef OPTEE_SMC_FAST_CALL_VAL
+#define OPTEE_SMC_FAST_CALL_VAL(func_num) \
+	ARM_SMCCC_CALL_VAL(ARM_SMCCC_FAST_CALL, ARM_SMCCC_SMC_32, \
+			   ARM_SMCCC_OWNER_TRUSTED_OS, (func_num))
+#endif
+/*
+ * Function specified by SMC Calling convention.
+ */
+#define OPTEE_SMC_FUNCID_READ_REG  17
+#define OPTEE_SMC_READ_REG \
+	OPTEE_SMC_FAST_CALL_VAL(OPTEE_SMC_FUNCID_READ_REG)
+
+
+#define OPTEE_SMC_FUNCID_WRITE_REG  18
+#define OPTEE_SMC_WRITE_REG \
+	OPTEE_SMC_FAST_CALL_VAL(OPTEE_SMC_FUNCID_WRITE_REG)
+
+#define OPTEE_SMC_FUNCID_COPY_ARISC_PARAS  19
+#define OPTEE_SMC_COPY_ARISC_PARAS \
+	OPTEE_SMC_FAST_CALL_VAL(OPTEE_SMC_FUNCID_COPY_ARISC_PARAS)
+#define ARM_SVC_COPY_ARISC_PARAS    OPTEE_SMC_COPY_ARISC_PARAS
+
+#define OPTEE_SMC_FUNCID_GET_TEEADDR_PARAS  20
+#define OPTEE_SMC_GET_TEEADDR_PARAS \
+	OPTEE_SMC_FAST_CALL_VAL(OPTEE_SMC_FUNCID_GET_TEEADDR_PARAS)
+#define ARM_SVC_GET_TEEADDR_PARAS    OPTEE_SMC_GET_TEEADDR_PARAS
+
+#ifdef CONFIG_ARM64
+/*cmd to call ATF service*/
+#define ARM_SVC_EFUSE_PROBE_SECURE_ENABLE    (0xc000fe03)
+#define ARM_SVC_READ_SEC_REG                 (0xC000ff05)
+#define ARM_SVC_WRITE_SEC_REG                (0xC000ff06)
+#else
+/*cmd to call TEE service*/
+#define ARM_SVC_READ_SEC_REG        OPTEE_SMC_READ_REG
+#define ARM_SVC_WRITE_SEC_REG       OPTEE_SMC_WRITE_REG
+#endif
+
+/*interface for smc */
+u32 sunxi_smc_readl(phys_addr_t addr)
+{
+#if defined(CONFIG_ARM64)
+	return invoke_smc_fn(ARM_SVC_READ_SEC_REG, addr, 0, 0);
+#elif defined(CONFIG_TEE)
+	struct arm_smccc_res res;
+	arm_smccc_smc(ARM_SVC_READ_SEC_REG, addr, 0, 0, 0, 0, 0, 0, &res);
+	return res.a0;
+#else
+	void __iomem *vaddr = ioremap(addr, 4);
+	u32 ret;
+	ret = readl(vaddr);
+	iounmap(vaddr);
+	return ret;
+#endif
+}
+EXPORT_SYMBOL_GPL(sunxi_smc_readl);
+
+int sunxi_smc_writel(u32 value, phys_addr_t addr)
+{
+#if defined(CONFIG_ARM64)
+	return invoke_smc_fn(ARM_SVC_WRITE_SEC_REG, addr, value, 0);
+#elif defined(CONFIG_TEE)
+	struct arm_smccc_res res;
+	arm_smccc_smc(ARM_SVC_WRITE_SEC_REG, addr, value, 0, 0, 0, 0, 0, &res);
+	return res.a0;
+#else
+	void __iomem *vaddr = ioremap(addr, 4);
+	writel(value, vaddr);
+	iounmap(vaddr);
+	return 0;
+#endif
+}
+EXPORT_SYMBOL_GPL(sunxi_smc_writel);
+
+int sunxi_smc_copy_arisc_paras(phys_addr_t dest, phys_addr_t src, u32 len)
+{
+	struct arm_smccc_res res;
+	arm_smccc_smc(ARM_SVC_COPY_ARISC_PARAS, dest, src, len, 0, 0, 0, 0, &res);
+	return res.a0;
+}
+
+phys_addr_t sunxi_smc_get_teeaddr_paras(phys_addr_t resumeaddr)
+{
+	struct arm_smccc_res res;
+
+	arm_smccc_smc(ARM_SVC_GET_TEEADDR_PARAS,
+		resumeaddr, 0, 0, 0, 0, 0, 0, &res);
+	return res.a0;
+}
+/*optee smc*/
+#define ARM_SMCCC_SMC_32		0
+#define ARM_SMCCC_SMC_64		1
+#define ARM_SMCCC_CALL_CONV_SHIFT	30
+
+#define ARM_SMCCC_OWNER_MASK		0x3F
+#define ARM_SMCCC_OWNER_SHIFT		24
+
+#define ARM_SMCCC_FUNC_MASK		0xFFFF
+#define ARM_SMCCC_OWNER_TRUSTED_OS	50
+
+#define ARM_SMCCC_IS_FAST_CALL(smc_val)	\
+	((smc_val) & (ARM_SMCCC_FAST_CALL << ARM_SMCCC_TYPE_SHIFT))
+#define ARM_SMCCC_IS_64(smc_val) \
+	((smc_val) & (ARM_SMCCC_SMC_64 << ARM_SMCCC_CALL_CONV_SHIFT))
+#define ARM_SMCCC_FUNC_NUM(smc_val)	((smc_val) & ARM_SMCCC_FUNC_MASK)
+#define ARM_SMCCC_OWNER_NUM(smc_val) \
+	(((smc_val) >> ARM_SMCCC_OWNER_SHIFT) & ARM_SMCCC_OWNER_MASK)
+
+#define ARM_SMCCC_CALL_VAL(type, calling_convention, owner, func_num) \
+	(((type) << ARM_SMCCC_TYPE_SHIFT) | \
+	((calling_convention) << ARM_SMCCC_CALL_CONV_SHIFT) | \
+	(((owner) & ARM_SMCCC_OWNER_MASK) << ARM_SMCCC_OWNER_SHIFT) | \
+	((func_num) & ARM_SMCCC_FUNC_MASK))
+
+#define OPTEE_SMC_FAST_CALL_VAL(func_num) \
+	ARM_SMCCC_CALL_VAL(ARM_SMCCC_FAST_CALL, ARM_SMCCC_SMC_32, \
+			   ARM_SMCCC_OWNER_TRUSTED_OS, (func_num))
+
+#define OPTEE_SMC_FUNCID_CRYPT  16
+#define OPTEE_SMC_CRYPT \
+	OPTEE_SMC_FAST_CALL_VAL(OPTEE_SMC_FUNCID_CRYPT)
+
+#define TEESMC_RSSK_DECRYPT      5
+int sunxi_smc_refresh_hdcp(void)
+{
+	return invoke_smc_fn(OPTEE_SMC_CRYPT, TEESMC_RSSK_DECRYPT, 0, 0);
+}
+EXPORT_SYMBOL(sunxi_smc_refresh_hdcp);
+