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 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 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