GK SDK 源码库: XMIPCLinuxV100R005C00SPC030 (kernel/tools/open_source excluded)

This commit is contained in:
lai
2026-09-06 03:52:57 +08:00
commit b1928b41c0
21813 changed files with 4413081 additions and 0 deletions
@@ -0,0 +1,39 @@
/*
* Copyright (c) 2022, MediaTek Inc. All rights reserved.
*
* SPDX-License-Identifier: BSD-3-Clause
*/
#include <common/debug.h>
#include <lib/utils_def.h>
#include <lib/mtk_init/mtk_init.h>
INIT_CALL_TABLE(EXPAND_AS_EXTERN);
extern struct initcall __MTK_PLAT_INITCALL_END__[];
struct initcall *initcall_list[] = {
INIT_CALL_TABLE(EXPAND_AS_SYMBOL_ARR)
__MTK_PLAT_INITCALL_END__
};
void mtk_init_one_level(uint32_t level)
{
const struct initcall *entry;
int error;
if (level >= MTK_INIT_LVL_MAX) {
ERROR("invalid level:%u\n", level);
panic();
}
INFO("init calling level:%u\n", level);
for (entry = initcall_list[level];
(entry != NULL) && (entry < initcall_list[level + 1]);
entry++) {
INFO("calling %s\n", entry->name);
error = entry->fn();
if (error != 0) {
ERROR("init %s fail, errno:%d\n", entry->name, error);
}
}
}
@@ -0,0 +1,55 @@
/*
* Copyright (c) 2022, MediaTek Inc. All rights reserved.
*
* SPDX-License-Identifier: BSD-3-Clause
*/
#include <assert.h>
#include <common/bl_common.h>
#include <common/debug.h>
#include <drivers/console.h>
#include <lib/xlat_tables/xlat_tables_compat.h>
#include <mtk_mmap_pool.h>
IMPORT_SYM(uintptr_t, __MTK_MMAP_POINTER_POOL_START__, MTK_MMAP_POINTER_POOL_START);
IMPORT_SYM(uintptr_t, __MTK_MMAP_POINTER_POOL_END_UNALIGNED__, MTK_MMAP_POINTER_POOL_END_UNALIGNED);
IMPORT_SYM(uintptr_t, __RW_START__, RW_START);
IMPORT_SYM(uintptr_t, __DATA_START__, DATA_START);
#define MAP_MTK_SECTIONS MAP_REGION_FLAT(RW_START, \
DATA_START - RW_START, \
MT_MEMORY | MT_RO | MT_SECURE)
static void print_mmap(const mmap_region_t *regions)
{
while (regions->size != 0U) {
VERBOSE("Region: 0x%lx - 0x%lx has attributes 0x%x\n",
regions->base_va,
regions->base_va + regions->size,
regions->attr);
regions++;
}
}
void mtk_xlat_init(const mmap_region_t *bl_regions)
{
struct mtk_mmap_descriptor *iter;
const mmap_region_t *regions = bl_regions;
print_mmap(regions);
mmap_add(bl_regions);
if (MTK_MMAP_POINTER_POOL_START != MTK_MMAP_POINTER_POOL_END_UNALIGNED) {
for (iter = (struct mtk_mmap_descriptor *)MTK_MMAP_POINTER_POOL_START;
(char *)iter < (char *)MTK_MMAP_POINTER_POOL_END_UNALIGNED;
iter++) {
regions = iter->mmap_ptr;
INFO("mmap_name: %s\n", iter->mmap_name);
INFO("mmap_size: 0x%x\n", iter->mmap_size);
print_mmap(regions);
mmap_add(regions);
}
}
init_xlat_tables();
enable_mmu_el3(0);
}
@@ -0,0 +1,14 @@
#
# Copyright (c) 2022, MediaTek Inc. All rights reserved.
#
# SPDX-License-Identifier: BSD-3-Clause
#
LOCAL_DIR := $(call GET_LOCAL_DIR)
MODULE := mtk_init
LOCAL_SRCS-y := $(LOCAL_DIR)/mtk_init.c
LOCAL_SRCS-y += $(LOCAL_DIR)/mtk_mmap_init.c
$(eval $(call MAKE_MODULE,$(MODULE),$(LOCAL_SRCS-y),$(MTK_BL)))
@@ -0,0 +1,543 @@
/*
* Copyright (c) 2022, Mediatek Inc. All rights reserved.
*
* SPDX-License-Identifier: BSD-3-Clause
*/
#include <assert.h>
#include <errno.h>
#include <common/debug.h>
#include <drivers/arm/gicv3.h>
#include <lib/psci/psci.h>
#include <lib/utils.h>
#ifdef MTK_PUBEVENT_ENABLE
#include <vendor_pubsub_events.h>
#endif
#include <plat/arm/common/plat_arm.h>
#include <plat/common/platform.h>
#include <dfd.h>
#include <lib/mtk_init/mtk_init.h>
#include <lib/pm/mtk_pm.h>
#include <mt_gic_v3.h>
#include <platform_def.h>
#define IS_AFFLV_PUBEVENT(_pstate) \
((_pstate & (MT_CPUPM_PWR_DOMAIN_MCUSYS | MT_CPUPM_PWR_DOMAIN_CLUSTER)) != 0)
#ifdef MTK_PUBEVENT_ENABLE
#define MT_CPUPM_EVENT_PWR_ON(x) ({ \
PUBLISH_EVENT_ARG(mt_cpupm_publish_pwr_on, (const void *)(x)); })
#define MT_CPUPM_EVENT_PWR_OFF(x) ({ \
PUBLISH_EVENT_ARG(mt_cpupm_publish_pwr_off, (const void *)(x)); })
#define MT_CPUPM_EVENT_AFFLV_PWR_ON(x) ({ \
PUBLISH_EVENT_ARG(mt_cpupm_publish_afflv_pwr_on, (const void *)(x)); })
#define MT_CPUPM_EVENT_AFFLV_PWR_OFF(x) ({ \
PUBLISH_EVENT_ARG(mt_cpupm_publish_afflv_pwr_off, (const void *)(x)); })
#else
#define MT_CPUPM_EVENT_PWR_ON(x) ({ (void)x; })
#define MT_CPUPM_EVENT_PWR_OFF(x) ({ (void)x; })
#define MT_CPUPM_EVENT_AFFLV_PWR_ON(x) ({ (void)x; })
#define MT_CPUPM_EVENT_AFFLV_PWR_OFF(x) ({ (void)x; })
#endif
/*
* The cpu require to cluster power stattus
* [0] : The cpu require cluster power down
* [1] : The cpu require cluster power on
*/
#define coordinate_cluster(onoff) write_clusterpwrdn_el1(onoff)
#define coordinate_cluster_pwron() coordinate_cluster(1)
#define coordinate_cluster_pwroff() coordinate_cluster(0)
/* defaultly disable all functions */
#define MTK_CPUPM_FN_MASK_DEFAULT (0)
struct mtk_cpu_pwr_ctrl {
unsigned int fn_mask;
struct mtk_cpu_pm_ops *ops;
struct mtk_cpu_smp_ops *smp;
};
static struct mtk_cpu_pwr_ctrl mtk_cpu_pwr = {
.fn_mask = MTK_CPUPM_FN_MASK_DEFAULT,
.ops = NULL,
};
#define IS_CPUIDLE_FN_ENABLE(x) ((mtk_cpu_pwr.ops != NULL) && ((mtk_cpu_pwr.fn_mask & x) != 0))
#define IS_CPUSMP_FN_ENABLE(x) ((mtk_cpu_pwr.smp != NULL) && ((mtk_cpu_pwr.fn_mask & x) != 0))
/* per-cpu power state */
static unsigned int armv8_2_power_state[PLATFORM_CORE_COUNT];
#define armv8_2_get_pwr_stateid(cpu) psci_get_pstate_id(armv8_2_power_state[cpu])
static unsigned int get_mediatek_pstate(unsigned int domain, unsigned int psci_state,
struct mtk_cpupm_pwrstate *state)
{
if (IS_CPUIDLE_FN_ENABLE(MTK_CPUPM_FN_CPUPM_GET_PWR_STATE)) {
return mtk_cpu_pwr.ops->get_pstate(domain, psci_state, state);
}
return 0;
}
unsigned int armv8_2_get_pwr_afflv(const psci_power_state_t *state_info)
{
int i;
for (i = (int)PLAT_MAX_PWR_LVL; i >= (int)PSCI_CPU_PWR_LVL; i--) {
if (is_local_state_run(state_info->pwr_domain_state[i]) == 0) {
return (unsigned int) i;
}
}
return PSCI_INVALID_PWR_LVL;
}
/* MediaTek mcusys power on control interface */
static void armv8_2_mcusys_pwr_on_common(const struct mtk_cpupm_pwrstate *state)
{
gicv3_distif_init();
mt_gic_distif_restore();
gic_sgi_restore_all();
dfd_resume();
/* Add code here that behavior before system enter mcusys'on */
if (IS_CPUIDLE_FN_ENABLE(MTK_CPUPM_FN_RESUME_MCUSYS)) {
mtk_cpu_pwr.ops->mcusys_resume(state);
}
}
/* MediaTek mcusys power down control interface */
static void armv8_2_mcusys_pwr_dwn_common(const struct mtk_cpupm_pwrstate *state)
{
mt_gic_distif_save();
gic_sgi_save_all();
/* Add code here that behaves before entering mcusys off */
if (IS_CPUIDLE_FN_ENABLE(MTK_CPUPM_FN_SUSPEND_MCUSYS)) {
mtk_cpu_pwr.ops->mcusys_suspend(state);
}
}
/* MediaTek Cluster power on control interface */
static void armv8_2_cluster_pwr_on_common(const struct mtk_cpupm_pwrstate *state)
{
/* Add code here that behavior before system enter cluster'on */
#if defined(MTK_CM_MGR) && !defined(MTK_FPGA_EARLY_PORTING)
/* init cpu stall counter */
init_cpu_stall_counter_all();
#endif
if (IS_CPUIDLE_FN_ENABLE(MTK_CPUPM_FN_RESUME_CLUSTER)) {
mtk_cpu_pwr.ops->cluster_resume(state);
}
}
/* MediaTek Cluster power down control interface */
static void armv8_2_cluster_pwr_dwn_common(const struct mtk_cpupm_pwrstate *state)
{
if (IS_CPUIDLE_FN_ENABLE(MTK_CPUPM_FN_SUSPEND_CLUSTER)) {
mtk_cpu_pwr.ops->cluster_suspend(state);
}
}
/* MediaTek CPU power on control interface */
static void armv8_2_cpu_pwr_on_common(const struct mtk_cpupm_pwrstate *state, unsigned int pstate)
{
coordinate_cluster_pwron();
gicv3_rdistif_init(plat_my_core_pos());
gicv3_cpuif_enable(plat_my_core_pos());
/* If MCUSYS has been powered down then restore GIC redistributor for all CPUs. */
if (IS_PLAT_SYSTEM_RETENTION(state->pwr.afflv)) {
mt_gic_rdistif_restore_all();
} else {
mt_gic_rdistif_restore();
}
}
/* MediaTek CPU power down control interface */
static void armv8_2_cpu_pwr_dwn_common(const struct mtk_cpupm_pwrstate *state, unsigned int pstate)
{
if ((pstate & MT_CPUPM_PWR_DOMAIN_PERCORE_DSU) != 0) {
coordinate_cluster_pwroff();
}
mt_gic_rdistif_save();
gicv3_cpuif_disable(plat_my_core_pos());
gicv3_rdistif_off(plat_my_core_pos());
}
static void armv8_2_cpu_pwr_resume(const struct mtk_cpupm_pwrstate *state, unsigned int pstate)
{
armv8_2_cpu_pwr_on_common(state, pstate);
if (IS_CPUIDLE_FN_ENABLE(MTK_CPUPM_FN_RESUME_CORE)) {
mtk_cpu_pwr.ops->cpu_resume(state);
}
}
static void armv8_2_cpu_pwr_suspend(const struct mtk_cpupm_pwrstate *state, unsigned int pstate)
{
if (IS_CPUIDLE_FN_ENABLE(MTK_CPUPM_FN_SUSPEND_CORE)) {
mtk_cpu_pwr.ops->cpu_suspend(state);
}
armv8_2_cpu_pwr_dwn_common(state, pstate);
}
static void armv8_2_cpu_pwr_on(const struct mtk_cpupm_pwrstate *state, unsigned int pstate)
{
armv8_2_cpu_pwr_on_common(state, pstate);
if (IS_CPUSMP_FN_ENABLE(MTK_CPUPM_FN_SMP_CORE_ON)) {
mtk_cpu_pwr.smp->cpu_on(state);
}
}
static void armv8_2_cpu_pwr_off(const struct mtk_cpupm_pwrstate *state, unsigned int pstate)
{
if (IS_CPUSMP_FN_ENABLE(MTK_CPUPM_FN_SMP_CORE_OFF)) {
mtk_cpu_pwr.smp->cpu_off(state);
}
armv8_2_cpu_pwr_dwn_common(state, pstate);
}
/* MediaTek PSCI power domain */
static int armv8_2_power_domain_on(u_register_t mpidr)
{
int ret = PSCI_E_SUCCESS;
int cpu = plat_core_pos_by_mpidr(mpidr);
uintptr_t entry = plat_pm_get_warm_entry();
if (IS_CPUSMP_FN_ENABLE(MTK_CPUPM_FN_PWR_ON_CORE_PREPARE)) {
if (mtk_cpu_pwr.smp->cpu_pwr_on_prepare(cpu, entry) != 0) {
ret = PSCI_E_DENIED;
}
}
INFO("CPU %u power domain prepare on\n", cpu);
return ret;
}
/* MediaTek PSCI power domain */
static void armv8_2_power_domain_on_finish(const psci_power_state_t *state)
{
struct mt_cpupm_event_data nb;
unsigned int pstate = (MT_CPUPM_PWR_DOMAIN_CORE | MT_CPUPM_PWR_DOMAIN_PERCORE_DSU);
struct mtk_cpupm_pwrstate pm_state = {
.info = {
.cpuid = plat_my_core_pos(),
.mode = MTK_CPU_PM_SMP,
},
.pwr = {
.afflv = armv8_2_get_pwr_afflv(state),
.state_id = 0x0,
},
};
armv8_2_cpu_pwr_on(&pm_state, pstate);
nb.cpuid = pm_state.info.cpuid;
nb.pwr_domain = pstate;
MT_CPUPM_EVENT_PWR_ON(&nb);
INFO("CPU %u power domain on finished\n", pm_state.info.cpuid);
}
/* MediaTek PSCI power domain */
static void armv8_2_power_domain_off(const psci_power_state_t *state)
{
struct mt_cpupm_event_data nb;
unsigned int pstate = (MT_CPUPM_PWR_DOMAIN_CORE | MT_CPUPM_PWR_DOMAIN_PERCORE_DSU);
struct mtk_cpupm_pwrstate pm_state = {
.info = {
.cpuid = plat_my_core_pos(),
.mode = MTK_CPU_PM_SMP,
},
.pwr = {
.afflv = armv8_2_get_pwr_afflv(state),
.state_id = 0x0,
},
};
armv8_2_cpu_pwr_off(&pm_state, pstate);
nb.cpuid = pm_state.info.cpuid;
nb.pwr_domain = pstate;
MT_CPUPM_EVENT_PWR_OFF(&nb);
INFO("CPU %u power domain off\n", pm_state.info.cpuid);
}
/* MediaTek PSCI power domain */
static void armv8_2_power_domain_suspend(const psci_power_state_t *state)
{
unsigned int pstate = 0;
struct mt_cpupm_event_data nb;
struct mtk_cpupm_pwrstate pm_state = {
.info = {
.cpuid = plat_my_core_pos(),
.mode = MTK_CPU_PM_CPUIDLE,
},
};
pm_state.pwr.state_id = armv8_2_get_pwr_stateid(pm_state.info.cpuid);
pm_state.pwr.afflv = armv8_2_get_pwr_afflv(state);
pm_state.pwr.raw = state;
pstate = get_mediatek_pstate(CPUPM_PWR_OFF,
armv8_2_power_state[pm_state.info.cpuid], &pm_state);
armv8_2_cpu_pwr_suspend(&pm_state, pstate);
if ((pstate & MT_CPUPM_PWR_DOMAIN_CLUSTER) != 0) {
armv8_2_cluster_pwr_dwn_common(&pm_state);
}
if ((pstate & MT_CPUPM_PWR_DOMAIN_MCUSYS) != 0) {
armv8_2_mcusys_pwr_dwn_common(&pm_state);
}
nb.cpuid = pm_state.info.cpuid;
nb.pwr_domain = pstate;
MT_CPUPM_EVENT_PWR_OFF(&nb);
if (IS_AFFLV_PUBEVENT(pstate)) {
MT_CPUPM_EVENT_AFFLV_PWR_OFF(&nb);
}
}
/* MediaTek PSCI power domain */
static void armv8_2_power_domain_suspend_finish(const psci_power_state_t *state)
{
unsigned int pstate = 0;
struct mt_cpupm_event_data nb;
struct mtk_cpupm_pwrstate pm_state = {
.info = {
.cpuid = plat_my_core_pos(),
.mode = MTK_CPU_PM_CPUIDLE,
},
};
pm_state.pwr.state_id = armv8_2_get_pwr_stateid(pm_state.info.cpuid);
pm_state.pwr.afflv = armv8_2_get_pwr_afflv(state);
pm_state.pwr.raw = state;
pstate = get_mediatek_pstate(CPUPM_PWR_ON,
armv8_2_power_state[pm_state.info.cpuid], &pm_state);
if ((pstate & MT_CPUPM_PWR_DOMAIN_MCUSYS) != 0) {
armv8_2_mcusys_pwr_on_common(&pm_state);
}
if ((pstate & MT_CPUPM_PWR_DOMAIN_CLUSTER) != 0) {
armv8_2_cluster_pwr_on_common(&pm_state);
}
armv8_2_cpu_pwr_resume(&pm_state, pstate);
nb.cpuid = pm_state.info.cpuid;
nb.pwr_domain = pstate;
MT_CPUPM_EVENT_PWR_ON(&nb);
if (IS_AFFLV_PUBEVENT(pstate)) {
MT_CPUPM_EVENT_AFFLV_PWR_ON(&nb);
}
}
/* MediaTek PSCI power domain */
static int armv8_2_validate_power_state(unsigned int power_state, psci_power_state_t *req_state)
{
unsigned int i;
unsigned int pstate = psci_get_pstate_type(power_state);
unsigned int aff_lvl = psci_get_pstate_pwrlvl(power_state);
unsigned int my_core_pos = plat_my_core_pos();
if (mtk_cpu_pwr.ops == NULL) {
return PSCI_E_INVALID_PARAMS;
}
if (IS_CPUIDLE_FN_ENABLE(MTK_CPUPM_FN_PWR_STATE_VALID)) {
if (mtk_cpu_pwr.ops->pwr_state_valid(aff_lvl, pstate) != 0) {
return PSCI_E_INVALID_PARAMS;
}
}
if (pstate == PSTATE_TYPE_STANDBY) {
req_state->pwr_domain_state[0] = PLAT_MAX_RET_STATE;
} else {
for (i = PSCI_CPU_PWR_LVL; i <= aff_lvl; i++) {
req_state->pwr_domain_state[i] = PLAT_MAX_OFF_STATE;
}
}
armv8_2_power_state[my_core_pos] = power_state;
return PSCI_E_SUCCESS;
}
/* MediaTek PSCI power domain */
#if CONFIG_MTK_SUPPORT_SYSTEM_SUSPEND
static void armv8_2_get_sys_suspend_power_state(psci_power_state_t *req_state)
{
unsigned int i;
int ret;
unsigned int power_state;
unsigned int my_core_pos = plat_my_core_pos();
ret = mtk_cpu_pwr.ops->pwr_state_valid(PLAT_MAX_PWR_LVL,
PSTATE_TYPE_POWERDOWN);
if (ret != MTK_CPUPM_E_OK) {
/* Avoid suspend due to platform is not ready. */
req_state->pwr_domain_state[PSCI_CPU_PWR_LVL] =
PLAT_MAX_RET_STATE;
for (i = PSCI_CPU_PWR_LVL + 1; i <= PLAT_MAX_PWR_LVL; i++) {
req_state->pwr_domain_state[i] = PSCI_LOCAL_STATE_RUN;
}
power_state = psci_make_powerstate(0, PSTATE_TYPE_STANDBY, PSCI_CPU_PWR_LVL);
} else {
for (i = PSCI_CPU_PWR_LVL; i <= PLAT_MAX_PWR_LVL; i++) {
req_state->pwr_domain_state[i] = PLAT_MAX_OFF_STATE;
}
power_state = psci_make_powerstate(MT_PLAT_PWR_STATE_SUSPEND,
PSTATE_TYPE_POWERDOWN, PLAT_MAX_PWR_LVL);
}
armv8_2_power_state[my_core_pos] = power_state;
flush_dcache_range((uintptr_t)&armv8_2_power_state[my_core_pos],
sizeof(armv8_2_power_state[my_core_pos]));
}
#endif
static void armv8_2_pm_smp_init(unsigned int cpu_id, uintptr_t entry_point)
{
if (entry_point == 0) {
ERROR("%s, warm_entry_point is null\n", __func__);
panic();
}
if (IS_CPUSMP_FN_ENABLE(MTK_CPUPM_FN_SMP_INIT)) {
mtk_cpu_pwr.smp->init(cpu_id, entry_point);
}
INFO("[%s:%d] - Initialize finished\n", __func__, __LINE__);
}
static struct plat_pm_pwr_ctrl armv8_2_pwr_ops = {
.pwr_domain_suspend = armv8_2_power_domain_suspend,
.pwr_domain_suspend_finish = armv8_2_power_domain_suspend_finish,
.validate_power_state = armv8_2_validate_power_state,
#if CONFIG_MTK_SUPPORT_SYSTEM_SUSPEND
.get_sys_suspend_power_state = armv8_2_get_sys_suspend_power_state,
#endif
};
struct plat_pm_smp_ctrl armv8_2_smp_ops = {
.init = armv8_2_pm_smp_init,
.pwr_domain_on = armv8_2_power_domain_on,
.pwr_domain_off = armv8_2_power_domain_off,
.pwr_domain_on_finish = armv8_2_power_domain_on_finish,
};
#define ISSUE_CPU_PM_REG_FAIL(_success) ({ _success = false; assert(0); })
#define CPM_PM_FN_CHECK(_fns, _ops, _id, _func, _result, _flag) ({ \
if ((_fns & _id)) { \
if (_ops->_func) \
_flag |= _id; \
else { \
ISSUE_CPU_PM_REG_FAIL(_result); \
} \
} })
int register_cpu_pm_ops(unsigned int fn_flags, struct mtk_cpu_pm_ops *ops)
{
bool success = true;
unsigned int fns = 0;
if ((ops == NULL) || (mtk_cpu_pwr.ops != NULL)) {
ERROR("[%s:%d] register cpu_pm fail !!\n", __FILE__, __LINE__);
return MTK_CPUPM_E_ERR;
}
CPM_PM_FN_CHECK(fn_flags, ops, MTK_CPUPM_FN_RESUME_CORE,
cpu_resume, success, fns);
CPM_PM_FN_CHECK(fn_flags, ops, MTK_CPUPM_FN_SUSPEND_CORE,
cpu_suspend, success, fns);
CPM_PM_FN_CHECK(fn_flags, ops, MTK_CPUPM_FN_RESUME_CLUSTER,
cluster_resume, success, fns);
CPM_PM_FN_CHECK(fn_flags, ops, MTK_CPUPM_FN_SUSPEND_CLUSTER,
cluster_suspend, success, fns);
CPM_PM_FN_CHECK(fn_flags, ops, MTK_CPUPM_FN_RESUME_MCUSYS,
mcusys_resume, success, fns);
CPM_PM_FN_CHECK(fn_flags, ops, MTK_CPUPM_FN_SUSPEND_MCUSYS,
mcusys_suspend, success, fns);
CPM_PM_FN_CHECK(fn_flags, ops, MTK_CPUPM_FN_CPUPM_GET_PWR_STATE,
get_pstate, success, fns);
CPM_PM_FN_CHECK(fn_flags, ops, MTK_CPUPM_FN_PWR_STATE_VALID,
pwr_state_valid, success, fns);
CPM_PM_FN_CHECK(fn_flags, ops, MTK_CPUPM_FN_INIT,
init, success, fns);
if (success) {
mtk_cpu_pwr.ops = ops;
mtk_cpu_pwr.fn_mask |= fns;
plat_pm_ops_setup_pwr(&armv8_2_pwr_ops);
INFO("[%s:%d] CPU pwr ops register success, support:0x%x\n",
__func__, __LINE__, fns);
} else {
ERROR("[%s:%d] register cpu_pm ops fail !, fn:0x%x\n",
__func__, __LINE__, fn_flags);
assert(0);
}
return MTK_CPUPM_E_OK;
}
int register_cpu_smp_ops(unsigned int fn_flags, struct mtk_cpu_smp_ops *ops)
{
bool success = true;
unsigned int fns = 0;
if ((ops == NULL) || (mtk_cpu_pwr.smp != NULL)) {
ERROR("[%s:%d] register cpu_smp fail !!\n", __FILE__, __LINE__);
return MTK_CPUPM_E_ERR;
}
CPM_PM_FN_CHECK(fn_flags, ops, MTK_CPUPM_FN_SMP_INIT,
init, success, fns);
CPM_PM_FN_CHECK(fn_flags, ops, MTK_CPUPM_FN_PWR_ON_CORE_PREPARE,
cpu_pwr_on_prepare, success, fns);
CPM_PM_FN_CHECK(fn_flags, ops, MTK_CPUPM_FN_SMP_CORE_ON,
cpu_on, success, fns);
CPM_PM_FN_CHECK(fn_flags, ops, MTK_CPUPM_FN_SMP_CORE_OFF,
cpu_off, success, fns);
if (success == true) {
mtk_cpu_pwr.smp = ops;
mtk_cpu_pwr.fn_mask |= fns;
plat_pm_ops_setup_smp(&armv8_2_smp_ops);
INFO("[%s:%d] CPU smp ops register success, support:0x%x\n",
__func__, __LINE__, fns);
} else {
ERROR("[%s:%d] register cpu_smp ops fail !, fn:0x%x\n",
__func__, __LINE__, fn_flags);
assert(0);
}
return MTK_CPUPM_E_OK;
}
@@ -0,0 +1,12 @@
#
# Copyright (c) 2022, MediaTek Inc. All rights reserved.
#
# SPDX-License-Identifier: BSD-3-Clause
#
LOCAL_DIR := $(call GET_LOCAL_DIR)
MODULE := armv${CONFIG_MTK_PM_ARCH}
LOCAL_SRCS-y := ${LOCAL_DIR}/pwr_ctrl.c
$(eval $(call MAKE_MODULE,$(MODULE),$(LOCAL_SRCS-y),$(MTK_BL)))
@@ -0,0 +1,120 @@
/*
* Copyright (c) 2022, MediaTek Inc. All rights reserved.
*
* SPDX-License-Identifier: BSD-3-Clause
*/
#include <assert.h>
#include <plat/common/platform.h>
#include <lib/pm/mtk_pm.h>
#define MTK_PM_ST_SMP_READY BIT(0)
#define MTK_PM_ST_PWR_READY BIT(1)
#define MTK_PM_ST_RESET_READY BIT(2)
static uintptr_t mtk_secure_entrypoint;
static plat_init_func mtk_plat_smp_init;
static plat_psci_ops_t mtk_pm_ops;
static unsigned int mtk_pm_status;
uintptr_t plat_pm_get_warm_entry(void)
{
return mtk_secure_entrypoint;
}
int plat_pm_ops_setup_pwr(struct plat_pm_pwr_ctrl *ops)
{
if (!ops) {
return MTK_CPUPM_E_FAIL;
}
#if CONFIG_MTK_CPU_SUSPEND_EN
if (!mtk_pm_ops.pwr_domain_suspend) {
mtk_pm_ops.pwr_domain_suspend = ops->pwr_domain_suspend;
}
if (!mtk_pm_ops.pwr_domain_suspend_finish) {
mtk_pm_ops.pwr_domain_suspend_finish = ops->pwr_domain_suspend_finish;
}
if (!mtk_pm_ops.validate_power_state) {
mtk_pm_ops.validate_power_state = ops->validate_power_state;
}
if (!mtk_pm_ops.get_sys_suspend_power_state) {
mtk_pm_ops.get_sys_suspend_power_state = ops->get_sys_suspend_power_state;
}
mtk_pm_status |= MTK_PM_ST_PWR_READY;
#endif
return MTK_CPUPM_E_OK;
}
int plat_pm_ops_setup_smp(struct plat_pm_smp_ctrl *ops)
{
if (!ops) {
return MTK_CPUPM_E_FAIL;
}
#if CONFIG_MTK_SMP_EN
if (!mtk_pm_ops.pwr_domain_on) {
mtk_pm_ops.pwr_domain_on = ops->pwr_domain_on;
}
if (!mtk_pm_ops.pwr_domain_on_finish) {
mtk_pm_ops.pwr_domain_on_finish = ops->pwr_domain_on_finish;
}
if (!mtk_pm_ops.pwr_domain_off) {
mtk_pm_ops.pwr_domain_off = ops->pwr_domain_off;
}
if (!mtk_plat_smp_init) {
mtk_plat_smp_init = ops->init;
}
mtk_pm_status |= MTK_PM_ST_SMP_READY;
#endif
return MTK_CPUPM_E_OK;
}
int plat_pm_ops_setup_reset(struct plat_pm_reset_ctrl *ops)
{
if (!ops) {
return MTK_CPUPM_E_FAIL;
}
if (!mtk_pm_ops.system_off) {
mtk_pm_ops.system_off = ops->system_off;
}
if (!mtk_pm_ops.system_reset) {
mtk_pm_ops.system_reset = ops->system_reset;
}
if (!mtk_pm_ops.system_reset2) {
mtk_pm_ops.system_reset2 = ops->system_reset2;
}
mtk_pm_status |= MTK_PM_ST_RESET_READY;
return MTK_CPUPM_E_OK;
}
int plat_setup_psci_ops(uintptr_t sec_entrypoint,
const plat_psci_ops_t **psci_ops)
{
*psci_ops = &mtk_pm_ops;
mtk_secure_entrypoint = sec_entrypoint;
if (mtk_plat_smp_init) {
unsigned int cpu_id = plat_my_core_pos();
mtk_plat_smp_init(cpu_id, mtk_secure_entrypoint);
}
INFO("%s, smp:(%d), pwr_ctrl:(%d), system_reset:(%d)\n", __func__,
!!(mtk_pm_status & MTK_PM_ST_SMP_READY),
!!(mtk_pm_status & MTK_PM_ST_PWR_READY),
!!(mtk_pm_status & MTK_PM_ST_RESET_READY));
return 0;
}
@@ -0,0 +1,223 @@
/*
* Copyright (c) 2022, Mediatek Inc. All rights reserved.
*
* SPDX-License-Identifier: BSD-3-Clause
*/
#ifndef MTK_PM_H
#define MTK_PM_H
#include <lib/psci/psci.h>
#if MTK_PUBEVENT_ENABLE
#include <vendor_pubsub_events.h>
#endif
#define MTK_CPUPM_E_OK (0)
#define MTK_CPUPM_E_UNKNOWN (-1)
#define MTK_CPUPM_E_ERR (-2)
#define MTK_CPUPM_E_FAIL (-3)
#define MTK_CPUPM_E_NOT_SUPPORT (-4)
#define MTK_CPUPM_FN_PWR_LOCK_AQUIRE BIT(0)
#define MTK_CPUPM_FN_INIT BIT(1)
#define MTK_CPUPM_FN_PWR_STATE_VALID BIT(2)
#define MTK_CPUPM_FN_PWR_ON_CORE_PREPARE BIT(3)
#define MTK_CPUPM_FN_SUSPEND_CORE BIT(4)
#define MTK_CPUPM_FN_RESUME_CORE BIT(5)
#define MTK_CPUPM_FN_SUSPEND_CLUSTER BIT(6)
#define MTK_CPUPM_FN_RESUME_CLUSTER BIT(7)
#define MTK_CPUPM_FN_SUSPEND_MCUSYS BIT(8)
#define MTK_CPUPM_FN_RESUME_MCUSYS BIT(9)
#define MTK_CPUPM_FN_CPUPM_GET_PWR_STATE BIT(10)
#define MTK_CPUPM_FN_SMP_INIT BIT(11)
#define MTK_CPUPM_FN_SMP_CORE_ON BIT(12)
#define MTK_CPUPM_FN_SMP_CORE_OFF BIT(13)
enum mtk_cpupm_pstate {
MTK_CPUPM_CORE_ON,
MTK_CPUPM_CORE_OFF,
MTK_CPUPM_CORE_SUSPEND,
MTK_CPUPM_CORE_RESUME,
MTK_CPUPM_CLUSTER_SUSPEND,
MTK_CPUPM_CLUSTER_RESUME,
MTK_CPUPM_MCUSYS_SUSPEND,
MTK_CPUPM_MCUSYS_RESUME,
};
enum mtk_cpu_pm_mode {
MTK_CPU_PM_CPUIDLE,
MTK_CPU_PM_SMP,
};
#define MT_IRQ_REMAIN_MAX (32)
#define MT_IRQ_REMAIN_CAT_LOG BIT(31)
struct mt_irqremain {
unsigned int count;
unsigned int irqs[MT_IRQ_REMAIN_MAX];
unsigned int wakeupsrc_cat[MT_IRQ_REMAIN_MAX];
unsigned int wakeupsrc[MT_IRQ_REMAIN_MAX];
};
typedef void (*plat_init_func)(unsigned int, uintptr_t);
struct plat_pm_smp_ctrl {
plat_init_func init;
int (*pwr_domain_on)(u_register_t mpidr);
void (*pwr_domain_off)(const psci_power_state_t *target_state);
void (*pwr_domain_on_finish)(const psci_power_state_t *target_state);
};
struct plat_pm_pwr_ctrl {
void (*pwr_domain_suspend)(const psci_power_state_t *target_state);
void (*pwr_domain_on_finish_late)(const psci_power_state_t *target_state);
void (*pwr_domain_suspend_finish)(const psci_power_state_t *target_state);
int (*validate_power_state)(unsigned int power_state, psci_power_state_t *req_state);
void (*get_sys_suspend_power_state)(psci_power_state_t *req_state);
};
struct plat_pm_reset_ctrl {
__dead2 void (*system_off)();
__dead2 void (*system_reset)();
int (*system_reset2)(int is_vendor, int reset_type, u_register_t cookie);
};
struct mtk_cpu_pm_info {
unsigned int cpuid;
unsigned int mode;
};
struct mtk_cpu_pm_state {
unsigned int afflv;
unsigned int state_id;
const psci_power_state_t *raw;
};
struct mtk_cpupm_pwrstate {
struct mtk_cpu_pm_info info;
struct mtk_cpu_pm_state pwr;
};
struct mtk_cpu_smp_ops {
void (*init)(unsigned int cpu, uintptr_t sec_entrypoint);
int (*cpu_pwr_on_prepare)(unsigned int cpu, uintptr_t entry);
void (*cpu_on)(const struct mtk_cpupm_pwrstate *state);
void (*cpu_off)(const struct mtk_cpupm_pwrstate *state);
int (*invoke)(unsigned int funcID, void *priv);
};
#define MT_CPUPM_PWR_DOMAIN_CORE BIT(0)
#define MT_CPUPM_PWR_DOMAIN_PERCORE_DSU BIT(1)
#define MT_CPUPM_PWR_DOMAIN_PERCORE_DSU_MEM BIT(2)
#define MT_CPUPM_PWR_DOMAIN_CLUSTER BIT(3)
#define MT_CPUPM_PWR_DOMAIN_MCUSYS BIT(4)
#define MT_CPUPM_PWR_DOMAIN_SUSPEND BIT(5)
enum mt_cpupm_pwr_domain {
CPUPM_PWR_ON,
CPUPM_PWR_OFF,
};
typedef unsigned int mtk_pstate_type;
struct mtk_cpu_pm_ops {
void (*init)(unsigned int cpu, uintptr_t sec_entrypoint);
unsigned int (*get_pstate)(enum mt_cpupm_pwr_domain domain,
const mtk_pstate_type psci_state,
const struct mtk_cpupm_pwrstate *state);
int (*pwr_state_valid)(unsigned int afflv, unsigned int state);
void (*cpu_suspend)(const struct mtk_cpupm_pwrstate *state);
void (*cpu_resume)(const struct mtk_cpupm_pwrstate *state);
void (*cluster_suspend)(const struct mtk_cpupm_pwrstate *state);
void (*cluster_resume)(const struct mtk_cpupm_pwrstate *state);
void (*mcusys_suspend)(const struct mtk_cpupm_pwrstate *state);
void (*mcusys_resume)(const struct mtk_cpupm_pwrstate *state);
int (*invoke)(unsigned int funcID, void *priv);
};
int register_cpu_pm_ops(unsigned int fn_flags, struct mtk_cpu_pm_ops *ops);
int register_cpu_smp_ops(unsigned int fn_flags, struct mtk_cpu_smp_ops *ops);
struct mt_cpupm_event_data {
unsigned int cpuid;
unsigned int pwr_domain;
};
/* Extension event for platform driver */
#if MTK_PUBEVENT_ENABLE
/* [PUB_EVENT] Core power on */
#define MT_CPUPM_SUBCRIBE_EVENT_PWR_ON(_fn) \
SUBSCRIBE_TO_EVENT(mt_cpupm_publish_pwr_on, _fn)
/* [PUB_EVENT] Core power off */
#define MT_CPUPM_SUBCRIBE_EVENT_PWR_OFF(_fn) \
SUBSCRIBE_TO_EVENT(mt_cpupm_publish_pwr_off, _fn)
/* [PUB_EVENT] Cluster power on */
#define MT_CPUPM_SUBCRIBE_CLUSTER_PWR_ON(_fn) \
SUBSCRIBE_TO_EVENT(mt_cpupm_publish_afflv_pwr_on, _fn)
/* [PUB_EVENT] Cluster power off */
#define MT_CPUPM_SUBCRIBE_CLUSTER_PWR_OFF(_fn) \
SUBSCRIBE_TO_EVENT(mt_cpupm_publish_afflv_pwr_off, _fn)
/* [PUB_EVENT] Mcusys power on */
#define MT_CPUPM_SUBCRIBE_MCUSYS_PWR_ON(_fn) \
SUBSCRIBE_TO_EVENT(mt_cpupm_publish_afflv_pwr_on, _fn)
/* [PUB_EVENT] Mcusys power off */
#define MT_CPUPM_SUBCRIBE_MCUSYS_PWR_OFF(_fn) \
SUBSCRIBE_TO_EVENT(mt_cpupm_publish_afflv_pwr_off, _fn)
#else
#define MT_CPUPM_SUBCRIBE_EVENT_PWR_ON(_fn)
#define MT_CPUPM_SUBCRIBE_EVENT_PWR_OFF(_fn)
#define MT_CPUPM_SUBCRIBE_CLUSTER_PWR_ON(_fn)
#define MT_CPUPM_SUBCRIBE_CLUSTER_PWR_OFF(_fn)
#define MT_CPUPM_SUBCRIBE_MCUSYS_PWR_ON(_fn)
#define MT_CPUPM_SUBCRIBE_MCUSYS_PWR_OFF(_fn)
#endif
/*
* Definition c-state power domain.
* bit[7:4] (main state id):
* - 1: Cluster.
* - 2: Mcusys.
* - 3: Memory.
* - 4: System pll.
* - 5: System bus.
* - 6: SoC 26m/DCXO.
* - 7: Vcore buck.
* - 15: Suspend.
* bit[3:0] (reserved for state_id extension):
* - 4: CPU buck.
*/
#define MT_PLAT_PWR_STATE_CLUSTER (0x0010)
#define MT_PLAT_PWR_STATE_MCUSYS (0x0020)
#define MT_PLAT_PWR_STATE_MCUSYS_BUCK (0x0024)
#define MT_PLAT_PWR_STATE_SYSTEM_MEM (0x0030)
#define MT_PLAT_PWR_STATE_SYSTEM_PLL (0x0040)
#define MT_PLAT_PWR_STATE_SYSTEM_BUS (0x0050)
#define MT_PLAT_PWR_STATE_SUSPEND (0x00f0)
#define IS_MT_PLAT_PWR_STATE(state, target_state) ((state & target_state) == target_state)
#define IS_MT_PLAT_PWR_STATE_MCUSYS(state) IS_MT_PLAT_PWR_STATE(state, MT_PLAT_PWR_STATE_MCUSYS)
#define PLAT_MT_SYSTEM_SUSPEND PLAT_MAX_OFF_STATE
#define PLAT_MT_CPU_SUSPEND_CLUSTER PLAT_MAX_RET_STATE
#define PLAT_MT_CPU_SUSPEND_MCUSYS PLAT_MAX_RET_STATE
#define IS_PLAT_SYSTEM_SUSPEND(aff) (aff == PLAT_MT_SYSTEM_SUSPEND)
#define IS_PLAT_SYSTEM_RETENTION(aff) (aff >= PLAT_MAX_RET_STATE)
#define IS_PLAT_SUSPEND_ID(stateid) (stateid == MT_PLAT_PWR_STATE_SUSPEND)
#define IS_PLAT_MCUSYSOFF_AFFLV(afflv) (afflv >= PLAT_MT_CPU_SUSPEND_MCUSYS)
int plat_pm_ops_setup_pwr(struct plat_pm_pwr_ctrl *ops);
int plat_pm_ops_setup_reset(struct plat_pm_reset_ctrl *ops);
int plat_pm_ops_setup_smp(struct plat_pm_smp_ctrl *ops);
uintptr_t plat_pm_get_warm_entry(void);
#endif
@@ -0,0 +1,17 @@
#
# Copyright (c) 2022, MediaTek Inc. All rights reserved.
#
# SPDX-License-Identifier: BSD-3-Clause
#
#
LOCAL_DIR := $(call GET_LOCAL_DIR)
MODULE := pm
LOCAL_SRCS-y := ${LOCAL_DIR}/mtk_pm.c
$(eval $(call MAKE_MODULE,$(MODULE),$(LOCAL_SRCS-y),$(MTK_BL)))
SUB_RULES-$(CONFIG_MTK_PM_SUPPORT) := $(LOCAL_DIR)/armv${CONFIG_MTK_PM_ARCH}
$(eval $(call INCLUDE_MAKEFILE,$(SUB_RULES-y)))
@@ -0,0 +1,56 @@
/*
* Copyright (c) 2022, MediaTek Inc. All rights reserved.
*
* SPDX-License-Identifier: BSD-3-Clause
*/
#include <assert.h>
#include <arch_helpers.h>
#include <common/debug.h>
#include <drivers/gpio.h>
#include <lib/mtk_init/mtk_init.h>
#include <lib/pm/mtk_pm.h>
#include <plat_params.h>
#include <pmic.h>
#include <rtc.h>
static void __dead2 mtk_system_reset_cros(void)
{
struct bl_aux_gpio_info *gpio_reset = plat_get_mtk_gpio_reset();
INFO("MTK System Reset\n");
gpio_set_value(gpio_reset->index, gpio_reset->polarity);
wfi();
ERROR("MTK System Reset: operation not handled.\n");
panic();
}
static void __dead2 mtk_system_off_cros(void)
{
INFO("MTK System Off\n");
rtc_power_off_sequence();
pmic_power_off();
wfi();
ERROR("MTK System Off: operation not handled.\n");
panic();
}
static struct plat_pm_reset_ctrl lib_reset_ctrl = {
.system_off = mtk_system_off_cros,
.system_reset = mtk_system_reset_cros,
.system_reset2 = NULL,
};
static int lib_reset_ctrl_init(void)
{
INFO("Reset init\n");
plat_pm_ops_setup_reset(&lib_reset_ctrl);
return 0;
}
MTK_ARCH_INIT(lib_reset_ctrl_init);
@@ -0,0 +1,14 @@
#
# Copyright (c) 2022, MediaTek Inc. All rights reserved.
#
# SPDX-License-Identifier: BSD-3-Clause
#
#
LOCAL_DIR := $(call GET_LOCAL_DIR)
MODULE := system_reset
LOCAL_SRCS-y := ${LOCAL_DIR}/reset_cros.c
$(eval $(call MAKE_MODULE,$(MODULE),$(LOCAL_SRCS-y),$(MTK_BL)))