mirror of
https://github.com/ARM-software/arm-trusted-firmware.git
synced 2025-04-16 09:34:18 +00:00
da8cc41bc8
LPM means low power module, it will connect idle and SPM to achieve lower power consumption in some scenarios, and this patch is LPM second version Signed-off-by: Wenzhen Yu <wenzhen.yu@mediatek.corp-partner.google.com> Change-Id: I6ae5b5b4c2056d08c29efab5116be3a92351d8f1
89 lines
2.1 KiB
C
89 lines
2.1 KiB
C
/*
|
|
* Copyright (c) 2025, MediaTek Inc. All rights reserved.
|
|
*
|
|
* SPDX-License-Identifier: BSD-3-Clause
|
|
*/
|
|
|
|
#include <cdefs.h>
|
|
|
|
#include <lpm_v2/mt_lpm_dispatch.h>
|
|
|
|
/*
|
|
* Notice, this data don't link to bss section.
|
|
* It means data structure won't be set as zero.
|
|
* Please make sure the member will be initialized.
|
|
*/
|
|
struct mt_dispatch_ctrl mt_dispatcher
|
|
__section("mt_lpm_s") = {
|
|
.enable = 0,
|
|
};
|
|
|
|
struct mt_dispatch_ctrl mt_secure_dispatcher
|
|
__section("mt_secure_lpm_s") = {
|
|
.enable = 0,
|
|
};
|
|
|
|
u_register_t invoke_mt_lpm_dispatch(u_register_t x1, u_register_t x2,
|
|
u_register_t x3, u_register_t x4,
|
|
void *handle, struct smccc_res *smccc_ret)
|
|
{
|
|
uint64_t res = 0;
|
|
uint32_t user;
|
|
|
|
if (!IS_MT_LPM_SMC(x1))
|
|
return res;
|
|
|
|
user = MT_LPM_SMC_USER(x1);
|
|
if ((user < MT_LPM_SMC_USER_MAX) &&
|
|
(mt_dispatcher.enable & (1 << user))) {
|
|
res = mt_dispatcher.fn[user](MT_LPM_SMC_USER_ID(x1),
|
|
x2, x3, x4,
|
|
handle, smccc_ret);
|
|
}
|
|
|
|
return res;
|
|
}
|
|
DECLARE_SMC_HANDLER(MTK_SIP_MTK_LPM_CONTROL, invoke_mt_lpm_dispatch);
|
|
|
|
u_register_t invoke_mt_secure_lpm_dispatch(u_register_t x1, u_register_t x2,
|
|
u_register_t x3, u_register_t x4,
|
|
void *handle,
|
|
struct smccc_res *smccc_ret)
|
|
{
|
|
uint64_t res = 0;
|
|
unsigned int user;
|
|
|
|
if (!IS_MT_LPM_SMC(x1))
|
|
return res;
|
|
|
|
user = MT_LPM_SMC_USER(x1);
|
|
if (mt_secure_dispatcher.enable & (1 << user)) {
|
|
res = mt_secure_dispatcher.fn[user](MT_LPM_SMC_USER_ID(x1), x2,
|
|
x3, x4, handle, smccc_ret);
|
|
}
|
|
|
|
return res;
|
|
}
|
|
DECLARE_SMC_HANDLER(MTK_SIP_BL_LPM_CONTROL, invoke_mt_secure_lpm_dispatch);
|
|
|
|
/* Check lpm smc user number at compile time */
|
|
CASSERT(MT_LPM_SMC_USER_MAX <= MTK_DISPATCH_ID_MAX,
|
|
lpm_smc_user_declare_too_large);
|
|
|
|
void mt_lpm_dispatcher_registry(unsigned int id, mt_lpm_dispatch_fn fn)
|
|
{
|
|
if (id >= MT_LPM_SMC_USER_MAX)
|
|
return;
|
|
|
|
mt_dispatcher.enable |= BIT(id);
|
|
mt_dispatcher.fn[id] = fn;
|
|
}
|
|
|
|
void mt_secure_lpm_dispatcher_registry(unsigned int id, mt_lpm_dispatch_fn fn)
|
|
{
|
|
if (id >= MT_LPM_SMC_USER_MAX)
|
|
return;
|
|
|
|
mt_secure_dispatcher.enable |= BIT(id);
|
|
mt_secure_dispatcher.fn[id] = fn;
|
|
}
|