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_security_ctrl_plat.h" 15 #include <lib/mtk_init/mtk_init.h> 16 #include <mtk_sip_svc.h> 17 18 static u_register_t apusys_kernel_handler(u_register_t x1, 19 u_register_t x2, 20 u_register_t x3, 21 u_register_t x4, 22 void *handle, 23 struct smccc_res *smccc_ret) 24 { 25 uint32_t request_ops; 26 int32_t ret = -1; 27 28 request_ops = (uint32_t)x1; 29 30 switch (request_ops) { 31 case MTK_APUSYS_KERNEL_OP_APUSYS_PWR_TOP_ON: 32 ret = apusys_kernel_apusys_pwr_top_on(); 33 break; 34 case MTK_APUSYS_KERNEL_OP_APUSYS_PWR_TOP_OFF: 35 ret = apusys_kernel_apusys_pwr_top_off(); 36 break; 37 default: 38 ERROR(MODULE_TAG "%s unknown request_ops = %x\n", MODULE_TAG, request_ops); 39 break; 40 } 41 42 return ret; 43 } 44 DECLARE_SMC_HANDLER(MTK_SIP_APUSYS_CONTROL, apusys_kernel_handler); 45 46 int apusys_init(void) 47 { 48 if (apusys_power_init() != 0) { 49 return -1; 50 } 51 52 if (apusys_devapc_ao_init() != 0) { 53 return -1; 54 } 55 56 apusys_security_ctrl_init(); 57 58 return 0; 59 } 60 MTK_PLAT_SETUP_1_INIT(apusys_init); 61