1938fd425SYidi Lin /* 2938fd425SYidi Lin * Copyright (c) 2020, 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> 97eb42237SRex-BC Chen #include <mt_dp.h> 10d562130eSDawei Chien #include <mt_spm.h> 11d562130eSDawei Chien #include <mt_spm_vcorefs.h> 127eb42237SRex-BC Chen #include <mtk_sip_svc.h> 13*3b994a75SRex-BC Chen #include <plat_dfd.h> 147eb42237SRex-BC Chen #include "plat_sip_calls.h" 15938fd425SYidi Lin 16938fd425SYidi Lin uintptr_t mediatek_plat_sip_handler(uint32_t smc_fid, 17938fd425SYidi Lin u_register_t x1, 18938fd425SYidi Lin u_register_t x2, 19938fd425SYidi Lin u_register_t x3, 20938fd425SYidi Lin u_register_t x4, 21938fd425SYidi Lin void *cookie, 22938fd425SYidi Lin void *handle, 23938fd425SYidi Lin u_register_t flags) 24938fd425SYidi Lin { 257eb42237SRex-BC Chen int32_t ret; 267eb42237SRex-BC Chen uint32_t ret_val; 277eb42237SRex-BC Chen 28938fd425SYidi Lin switch (smc_fid) { 297eb42237SRex-BC Chen case MTK_SIP_DP_CONTROL_AARCH32: 307eb42237SRex-BC Chen case MTK_SIP_DP_CONTROL_AARCH64: 317eb42237SRex-BC Chen ret = dp_secure_handler(x1, x2, &ret_val); 327eb42237SRex-BC Chen SMC_RET2(handle, ret, ret_val); 337eb42237SRex-BC Chen break; 34d562130eSDawei Chien case MTK_SIP_VCORE_CONTROL_ARCH32: 35d562130eSDawei Chien case MTK_SIP_VCORE_CONTROL_ARCH64: 36d562130eSDawei Chien ret = spm_vcorefs_v2_args(x1, x2, x3, &x4); 37d562130eSDawei Chien SMC_RET2(handle, ret, x4); 38d562130eSDawei Chien break; 39*3b994a75SRex-BC Chen case MTK_SIP_KERNEL_DFD_AARCH32: 40*3b994a75SRex-BC Chen case MTK_SIP_KERNEL_DFD_AARCH64: 41*3b994a75SRex-BC Chen ret = dfd_smc_dispatcher(x1, x2, x3, x4); 42*3b994a75SRex-BC Chen SMC_RET1(handle, ret); 43*3b994a75SRex-BC Chen break; 44938fd425SYidi Lin default: 45938fd425SYidi Lin ERROR("%s: unhandled SMC (0x%x)\n", __func__, smc_fid); 46938fd425SYidi Lin break; 47938fd425SYidi Lin } 48938fd425SYidi Lin 49938fd425SYidi Lin SMC_RET1(handle, SMC_UNK); 50938fd425SYidi Lin } 51