1*7079a942SFengquan Chen /*
2*7079a942SFengquan Chen * Copyright (c) 2022, MediaTek Inc. All rights reserved.
3*7079a942SFengquan Chen *
4*7079a942SFengquan Chen * SPDX-License-Identifier: BSD-3-Clause
5*7079a942SFengquan Chen */
6*7079a942SFengquan Chen #include <arch_helpers.h>
7*7079a942SFengquan Chen #include <common/debug.h>
8*7079a942SFengquan Chen #include <lib/mmio.h>
9*7079a942SFengquan Chen #include <dfd.h>
10*7079a942SFengquan Chen #include <mtk_sip_svc.h>
11*7079a942SFengquan Chen #include <plat_dfd.h>
12*7079a942SFengquan Chen
dfd_smc_dispatcher(u_register_t arg0,u_register_t arg1,u_register_t arg2,u_register_t arg3,void * handle,struct smccc_res * smccc_ret)13*7079a942SFengquan Chen static u_register_t dfd_smc_dispatcher(u_register_t arg0, u_register_t arg1,
14*7079a942SFengquan Chen u_register_t arg2, u_register_t arg3,
15*7079a942SFengquan Chen void *handle, struct smccc_res *smccc_ret)
16*7079a942SFengquan Chen {
17*7079a942SFengquan Chen int ret = MTK_SIP_E_SUCCESS;
18*7079a942SFengquan Chen
19*7079a942SFengquan Chen switch (arg0) {
20*7079a942SFengquan Chen case PLAT_MTK_DFD_SETUP_MAGIC:
21*7079a942SFengquan Chen INFO("[%s] DFD setup call from kernel\n", __func__);
22*7079a942SFengquan Chen dfd_setup(arg1, arg2, arg3);
23*7079a942SFengquan Chen break;
24*7079a942SFengquan Chen case PLAT_MTK_DFD_READ_MAGIC:
25*7079a942SFengquan Chen /* only allow to access DFD register base + 0x200 */
26*7079a942SFengquan Chen if (arg1 <= 0x200) {
27*7079a942SFengquan Chen ret = mmio_read_32(MISC1_CFG_BASE + arg1);
28*7079a942SFengquan Chen }
29*7079a942SFengquan Chen break;
30*7079a942SFengquan Chen case PLAT_MTK_DFD_WRITE_MAGIC:
31*7079a942SFengquan Chen /* only allow to access DFD register base + 0x200 */
32*7079a942SFengquan Chen if (arg1 <= 0x200) {
33*7079a942SFengquan Chen sync_writel(MISC1_CFG_BASE + arg1, arg2);
34*7079a942SFengquan Chen }
35*7079a942SFengquan Chen break;
36*7079a942SFengquan Chen default:
37*7079a942SFengquan Chen ret = MTK_SIP_E_INVALID_PARAM;
38*7079a942SFengquan Chen break;
39*7079a942SFengquan Chen }
40*7079a942SFengquan Chen
41*7079a942SFengquan Chen return ret;
42*7079a942SFengquan Chen }
43*7079a942SFengquan Chen DECLARE_SMC_HANDLER(MTK_SIP_KERNEL_DFD, dfd_smc_dispatcher);
44