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> 12*88906b44SFlora Fu #include <mtk_apusys.h> 137eb42237SRex-BC Chen #include <mtk_sip_svc.h> 143b994a75SRex-BC Chen #include <plat_dfd.h> 157eb42237SRex-BC Chen #include "plat_sip_calls.h" 16938fd425SYidi Lin 17938fd425SYidi Lin uintptr_t mediatek_plat_sip_handler(uint32_t smc_fid, 18938fd425SYidi Lin u_register_t x1, 19938fd425SYidi Lin u_register_t x2, 20938fd425SYidi Lin u_register_t x3, 21938fd425SYidi Lin u_register_t x4, 22938fd425SYidi Lin void *cookie, 23938fd425SYidi Lin void *handle, 24938fd425SYidi Lin u_register_t flags) 25938fd425SYidi Lin { 267eb42237SRex-BC Chen int32_t ret; 277eb42237SRex-BC Chen uint32_t ret_val; 287eb42237SRex-BC Chen 29938fd425SYidi Lin switch (smc_fid) { 307eb42237SRex-BC Chen case MTK_SIP_DP_CONTROL_AARCH32: 317eb42237SRex-BC Chen case MTK_SIP_DP_CONTROL_AARCH64: 327eb42237SRex-BC Chen ret = dp_secure_handler(x1, x2, &ret_val); 337eb42237SRex-BC Chen SMC_RET2(handle, ret, ret_val); 347eb42237SRex-BC Chen break; 35d562130eSDawei Chien case MTK_SIP_VCORE_CONTROL_ARCH32: 36d562130eSDawei Chien case MTK_SIP_VCORE_CONTROL_ARCH64: 37d562130eSDawei Chien ret = spm_vcorefs_v2_args(x1, x2, x3, &x4); 38d562130eSDawei Chien SMC_RET2(handle, ret, x4); 39d562130eSDawei Chien break; 403b994a75SRex-BC Chen case MTK_SIP_KERNEL_DFD_AARCH32: 413b994a75SRex-BC Chen case MTK_SIP_KERNEL_DFD_AARCH64: 423b994a75SRex-BC Chen ret = dfd_smc_dispatcher(x1, x2, x3, x4); 433b994a75SRex-BC Chen SMC_RET1(handle, ret); 443b994a75SRex-BC Chen break; 45*88906b44SFlora Fu case MTK_SIP_APUSYS_CONTROL_AARCH32: 46*88906b44SFlora Fu case MTK_SIP_APUSYS_CONTROL_AARCH64: 47*88906b44SFlora Fu ret = apusys_kernel_ctrl(x1, x2, x3, x4, &ret_val); 48*88906b44SFlora Fu SMC_RET2(handle, ret, ret_val); 49*88906b44SFlora Fu break; 50938fd425SYidi Lin default: 51938fd425SYidi Lin ERROR("%s: unhandled SMC (0x%x)\n", __func__, smc_fid); 52938fd425SYidi Lin break; 53938fd425SYidi Lin } 54938fd425SYidi Lin 55938fd425SYidi Lin SMC_RET1(handle, SMC_UNK); 56938fd425SYidi Lin } 57