1938fd425SYidi Lin /*
2ccc61e10SBo-Chen Chen * Copyright (c) 2020-2023, MediaTek Inc. All rights reserved.
3938fd425SYidi Lin *
4938fd425SYidi Lin * SPDX-License-Identifier: BSD-3-Clause
5938fd425SYidi Lin */
6938fd425SYidi Lin
7938fd425SYidi Lin #include <common/debug.h>
8938fd425SYidi Lin #include <common/runtime_svc.h>
9ccc61e10SBo-Chen Chen #include <emi_mpu.h>
107eb42237SRex-BC Chen #include <mt_dp.h>
11d562130eSDawei Chien #include <mt_spm.h>
12d562130eSDawei Chien #include <mt_spm_vcorefs.h>
1388906b44SFlora Fu #include <mtk_apusys.h>
147eb42237SRex-BC Chen #include <mtk_sip_svc.h>
153b994a75SRex-BC Chen #include <plat_dfd.h>
167eb42237SRex-BC Chen #include "plat_sip_calls.h"
17938fd425SYidi Lin
mediatek_plat_sip_handler(uint32_t smc_fid,u_register_t x1,u_register_t x2,u_register_t x3,u_register_t x4,void * cookie,void * handle,u_register_t flags)18938fd425SYidi Lin uintptr_t mediatek_plat_sip_handler(uint32_t smc_fid,
19938fd425SYidi Lin u_register_t x1,
20938fd425SYidi Lin u_register_t x2,
21938fd425SYidi Lin u_register_t x3,
22938fd425SYidi Lin u_register_t x4,
23938fd425SYidi Lin void *cookie,
24938fd425SYidi Lin void *handle,
25938fd425SYidi Lin u_register_t flags)
26938fd425SYidi Lin {
277eb42237SRex-BC Chen int32_t ret;
287eb42237SRex-BC Chen uint32_t ret_val;
297eb42237SRex-BC Chen
30938fd425SYidi Lin switch (smc_fid) {
31ccc61e10SBo-Chen Chen case MTK_SIP_TEE_MPU_PERM_SET_AARCH64:
32ccc61e10SBo-Chen Chen case MTK_SIP_TEE_MPU_PERM_SET_AARCH32:
33ccc61e10SBo-Chen Chen ret = emi_mpu_sip_handler(x1, x2, x3);
34*8914774eSBoyan Karatotev SMC_RET1(handle, ret);
35ccc61e10SBo-Chen Chen break;
367eb42237SRex-BC Chen case MTK_SIP_DP_CONTROL_AARCH32:
377eb42237SRex-BC Chen case MTK_SIP_DP_CONTROL_AARCH64:
387eb42237SRex-BC Chen ret = dp_secure_handler(x1, x2, &ret_val);
397eb42237SRex-BC Chen SMC_RET2(handle, ret, ret_val);
407eb42237SRex-BC Chen break;
412f3f5939SLeon Chen case MTK_SIP_VCORE_CONTROL_AARCH32:
422f3f5939SLeon Chen case MTK_SIP_VCORE_CONTROL_AARCH64:
43d562130eSDawei Chien ret = spm_vcorefs_v2_args(x1, x2, x3, &x4);
44d562130eSDawei Chien SMC_RET2(handle, ret, x4);
45d562130eSDawei Chien break;
463b994a75SRex-BC Chen case MTK_SIP_KERNEL_DFD_AARCH32:
473b994a75SRex-BC Chen case MTK_SIP_KERNEL_DFD_AARCH64:
483b994a75SRex-BC Chen ret = dfd_smc_dispatcher(x1, x2, x3, x4);
493b994a75SRex-BC Chen SMC_RET1(handle, ret);
503b994a75SRex-BC Chen break;
5188906b44SFlora Fu case MTK_SIP_APUSYS_CONTROL_AARCH32:
5288906b44SFlora Fu case MTK_SIP_APUSYS_CONTROL_AARCH64:
5388906b44SFlora Fu ret = apusys_kernel_ctrl(x1, x2, x3, x4, &ret_val);
5488906b44SFlora Fu SMC_RET2(handle, ret, ret_val);
5588906b44SFlora Fu break;
56938fd425SYidi Lin default:
57938fd425SYidi Lin ERROR("%s: unhandled SMC (0x%x)\n", __func__, smc_fid);
58938fd425SYidi Lin break;
59938fd425SYidi Lin }
60938fd425SYidi Lin
61938fd425SYidi Lin SMC_RET1(handle, SMC_UNK);
62938fd425SYidi Lin }
63