1 /*
2 * Copyright (c) 2023, MediaTek Inc. All rights reserved.
3 *
4 * SPDX-License-Identifier: BSD-3-Clause
5 */
6
7 /* TF-A system header */
8 #include <common/debug.h>
9
10 /* Vendor header */
11 #include "apusys.h"
12 #include "apusys_devapc.h"
13 #include "apusys_power.h"
14 #include "apusys_rv.h"
15 #include "apusys_security_ctrl_plat.h"
16 #include <lib/mtk_init/mtk_init.h>
17 #include <mtk_sip_svc.h>
18
apusys_kernel_handler(u_register_t x1,u_register_t x2,u_register_t x3,u_register_t x4,void * handle,struct smccc_res * smccc_ret)19 static u_register_t apusys_kernel_handler(u_register_t x1,
20 u_register_t x2,
21 u_register_t x3,
22 u_register_t x4,
23 void *handle,
24 struct smccc_res *smccc_ret)
25 {
26 uint32_t request_ops;
27 int32_t ret = -1;
28
29 request_ops = (uint32_t)x1;
30
31 switch (request_ops) {
32 case MTK_APUSYS_KERNEL_OP_APUSYS_PWR_TOP_ON:
33 ret = apusys_kernel_apusys_rv_pwr_ctrl(APU_PWR_ON);
34 break;
35 case MTK_APUSYS_KERNEL_OP_APUSYS_PWR_TOP_OFF:
36 ret = apusys_kernel_apusys_rv_pwr_ctrl(APU_PWR_OFF);
37 break;
38 case MTK_APUSYS_KERNEL_OP_APUSYS_RV_SETUP_REVISER:
39 ret = apusys_kernel_apusys_rv_setup_reviser();
40 break;
41 case MTK_APUSYS_KERNEL_OP_APUSYS_RV_RESET_MP:
42 ret = apusys_kernel_apusys_rv_reset_mp();
43 break;
44 case MTK_APUSYS_KERNEL_OP_APUSYS_RV_SETUP_BOOT:
45 ret = apusys_kernel_apusys_rv_setup_boot();
46 break;
47 case MTK_APUSYS_KERNEL_OP_APUSYS_RV_START_MP:
48 ret = apusys_kernel_apusys_rv_start_mp();
49 break;
50 case MTK_APUSYS_KERNEL_OP_APUSYS_RV_STOP_MP:
51 ret = apusys_kernel_apusys_rv_stop_mp();
52 break;
53 case MTK_APUSYS_KERNEL_OP_DEVAPC_INIT_RCX:
54 ret = apusys_devapc_rcx_init();
55 break;
56 case MTK_APUSYS_KERNEL_OP_APUSYS_RV_SETUP_SEC_MEM:
57 ret = apusys_kernel_apusys_rv_setup_sec_mem();
58 break;
59 case MTK_APUSYS_KERNEL_OP_APUSYS_RV_DISABLE_WDT_ISR:
60 ret = apusys_kernel_apusys_rv_disable_wdt_isr();
61 break;
62 case MTK_APUSYS_KERNEL_OP_APUSYS_RV_CLEAR_WDT_ISR:
63 ret = apusys_kernel_apusys_rv_clear_wdt_isr();
64 break;
65 case MTK_APUSYS_KERNEL_OP_APUSYS_RV_CG_GATING:
66 ret = apusys_kernel_apusys_rv_cg_gating();
67 break;
68 case MTK_APUSYS_KERNEL_OP_APUSYS_RV_CG_UNGATING:
69 ret = apusys_kernel_apusys_rv_cg_ungating();
70 break;
71 case MTK_APUSYS_KERNEL_OP_APUSYS_RV_SETUP_APUMMU:
72 ret = apusys_kernel_apusys_rv_setup_apummu();
73 break;
74 #ifdef CONFIG_MTK_APUSYS_LOGTOP_SUPPORT
75 case MTK_APUSYS_KERNEL_OP_APUSYS_LOGTOP_REG_DUMP:
76 ret = apusys_kernel_apusys_logtop_reg_dump((uint32_t)x2, smccc_ret);
77 break;
78 case MTK_APUSYS_KERNEL_OP_APUSYS_LOGTOP_REG_WRITE:
79 ret = apusys_kernel_apusys_logtop_reg_write((uint32_t)x2, (uint32_t)x3,
80 smccc_ret);
81 break;
82 case MTK_APUSYS_KERNEL_OP_APUSYS_LOGTOP_REG_W1C:
83 ret = apusys_kernel_apusys_logtop_reg_w1c((uint32_t)x2, smccc_ret);
84 break;
85 #endif
86 case MTK_APUSYS_KERNEL_OP_APUSYS_COLD_BOOT_CLR_MBOX_DUMMY:
87 ret = apusys_rv_cold_boot_clr_mbox_dummy();
88 break;
89 case MTK_APUSYS_KERNEL_OP_APUSYS_SETUP_CE_BIN:
90 ret = apusys_rv_setup_ce_bin();
91 break;
92 default:
93 ERROR(MODULE_TAG "%s unknown request_ops = %x\n", MODULE_TAG, request_ops);
94 break;
95 }
96
97 return ret;
98 }
99 DECLARE_SMC_HANDLER(MTK_SIP_APUSYS_CONTROL, apusys_kernel_handler);
100
apusys_init(void)101 int apusys_init(void)
102 {
103 if (apusys_power_init() != 0) {
104 return -1;
105 }
106
107 if (apusys_devapc_ao_init() != 0) {
108 return -1;
109 }
110
111 apusys_security_ctrl_init();
112 apusys_rv_mbox_mpu_init();
113
114 return 0;
115 }
116 MTK_PLAT_SETUP_1_INIT(apusys_init);
117