152430916SChungying Lu /* 252430916SChungying Lu * Copyright (c) 2023, MediaTek Inc. All rights reserved. 352430916SChungying Lu * 452430916SChungying Lu * SPDX-License-Identifier: BSD-3-Clause 552430916SChungying Lu */ 652430916SChungying Lu 752430916SChungying Lu /* TF-A system header */ 852430916SChungying Lu #include <common/debug.h> 952430916SChungying Lu 1052430916SChungying Lu /* Vendor header */ 1152430916SChungying Lu #include "apusys.h" 12777e3b71SKarl Li #include "apusys_devapc.h" 1352430916SChungying Lu #include "apusys_power.h" 14ad7673adSKarl Li #include "apusys_rv.h" 15b5900c92SKarl Li #include "apusys_security_ctrl_plat.h" 1652430916SChungying Lu #include <lib/mtk_init/mtk_init.h> 178e38b928SChungying Lu #include <mtk_sip_svc.h> 188e38b928SChungying Lu 198e38b928SChungying Lu static u_register_t apusys_kernel_handler(u_register_t x1, 208e38b928SChungying Lu u_register_t x2, 218e38b928SChungying Lu u_register_t x3, 228e38b928SChungying Lu u_register_t x4, 238e38b928SChungying Lu void *handle, 248e38b928SChungying Lu struct smccc_res *smccc_ret) 258e38b928SChungying Lu { 268e38b928SChungying Lu uint32_t request_ops; 278e38b928SChungying Lu int32_t ret = -1; 288e38b928SChungying Lu 298e38b928SChungying Lu request_ops = (uint32_t)x1; 308e38b928SChungying Lu 318e38b928SChungying Lu switch (request_ops) { 328e38b928SChungying Lu case MTK_APUSYS_KERNEL_OP_APUSYS_PWR_TOP_ON: 338e38b928SChungying Lu ret = apusys_kernel_apusys_pwr_top_on(); 348e38b928SChungying Lu break; 358e38b928SChungying Lu case MTK_APUSYS_KERNEL_OP_APUSYS_PWR_TOP_OFF: 368e38b928SChungying Lu ret = apusys_kernel_apusys_pwr_top_off(); 378e38b928SChungying Lu break; 3894a9e624SChungying Lu case MTK_APUSYS_KERNEL_OP_APUSYS_RV_SETUP_REVISER: 3994a9e624SChungying Lu ret = apusys_kernel_apusys_rv_setup_reviser(); 4094a9e624SChungying Lu break; 4194a9e624SChungying Lu case MTK_APUSYS_KERNEL_OP_APUSYS_RV_RESET_MP: 4294a9e624SChungying Lu ret = apusys_kernel_apusys_rv_reset_mp(); 4394a9e624SChungying Lu break; 4494a9e624SChungying Lu case MTK_APUSYS_KERNEL_OP_APUSYS_RV_SETUP_BOOT: 4594a9e624SChungying Lu ret = apusys_kernel_apusys_rv_setup_boot(); 4694a9e624SChungying Lu break; 4794a9e624SChungying Lu case MTK_APUSYS_KERNEL_OP_APUSYS_RV_START_MP: 4894a9e624SChungying Lu ret = apusys_kernel_apusys_rv_start_mp(); 4994a9e624SChungying Lu break; 5094a9e624SChungying Lu case MTK_APUSYS_KERNEL_OP_APUSYS_RV_STOP_MP: 5194a9e624SChungying Lu ret = apusys_kernel_apusys_rv_stop_mp(); 5294a9e624SChungying Lu break; 53*5986ae57SKarl Li case MTK_APUSYS_KERNEL_OP_DEVAPC_INIT_RCX: 54*5986ae57SKarl Li ret = apusys_devapc_rcx_init(); 55*5986ae57SKarl Li break; 568e38b928SChungying Lu default: 578e38b928SChungying Lu ERROR(MODULE_TAG "%s unknown request_ops = %x\n", MODULE_TAG, request_ops); 588e38b928SChungying Lu break; 598e38b928SChungying Lu } 608e38b928SChungying Lu 618e38b928SChungying Lu return ret; 628e38b928SChungying Lu } 638e38b928SChungying Lu DECLARE_SMC_HANDLER(MTK_SIP_APUSYS_CONTROL, apusys_kernel_handler); 6452430916SChungying Lu 6552430916SChungying Lu int apusys_init(void) 6652430916SChungying Lu { 67777e3b71SKarl Li if (apusys_power_init() != 0) { 68777e3b71SKarl Li return -1; 69777e3b71SKarl Li } 70777e3b71SKarl Li 71777e3b71SKarl Li if (apusys_devapc_ao_init() != 0) { 72777e3b71SKarl Li return -1; 73777e3b71SKarl Li } 74777e3b71SKarl Li 75b5900c92SKarl Li apusys_security_ctrl_init(); 76ad7673adSKarl Li apusys_rv_mbox_mpu_init(); 77b5900c92SKarl Li 7852430916SChungying Lu return 0; 7952430916SChungying Lu } 8052430916SChungying Lu MTK_PLAT_SETUP_1_INIT(apusys_init); 81