1938fd425SYidi Lin /* 2*ccc61e10SBo-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> 9*ccc61e10SBo-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 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) { 31*ccc61e10SBo-Chen Chen case MTK_SIP_TEE_MPU_PERM_SET_AARCH64: 32*ccc61e10SBo-Chen Chen case MTK_SIP_TEE_MPU_PERM_SET_AARCH32: 33*ccc61e10SBo-Chen Chen ret = emi_mpu_sip_handler(x1, x2, x3); 34*ccc61e10SBo-Chen Chen SMC_RET2(handle, ret, ret_val); 35*ccc61e10SBo-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