50 lines
1.1 KiB
C
50 lines
1.1 KiB
C
|
/* SPDX-License-Identifier: GPL-2.0 */
|
||
|
|
/*
|
||
|
|
* Copyright (c) 2019 MediaTek Inc.
|
||
|
|
*/
|
||
|
|
|
||
|
|
#include "helio-dvfsrc-smc-control.h"
|
||
|
|
|
||
|
|
#define SPM_FLAG_RUN_COMMON_SCENARIO (1U << 10)
|
||
|
|
#define SPM_FLAG_DIS_VCORE_DVS (1U << 3)
|
||
|
|
#define SPM_FLAG_DIS_VCORE_DFS (1U << 4)
|
||
|
|
|
||
|
|
inline void mtk_spmfw_init(int dvfsrc_en, int skip_check)
|
||
|
|
{
|
||
|
|
int dvfsrc_flag = dvfsrc_en >> 1;
|
||
|
|
unsigned int spm_flags = SPM_FLAG_RUN_COMMON_SCENARIO;
|
||
|
|
|
||
|
|
if (dvfsrc_en & 1) {
|
||
|
|
if (dvfsrc_flag & 0x1)
|
||
|
|
spm_flags |= SPM_FLAG_DIS_VCORE_DVS;
|
||
|
|
|
||
|
|
if (dvfsrc_flag & 0x2)
|
||
|
|
spm_flags |= SPM_FLAG_DIS_VCORE_DFS;
|
||
|
|
} else
|
||
|
|
spm_flags |= (
|
||
|
|
SPM_FLAG_DIS_VCORE_DVS | SPM_FLAG_DIS_VCORE_DFS);
|
||
|
|
|
||
|
|
if (helio_dvfsrc_firmware_status() &&
|
||
|
|
!skip_check)
|
||
|
|
return;
|
||
|
|
|
||
|
|
helio_dvfsrc_smc(VCOREFS_SMC_CMD_0, 0, 0, 0);
|
||
|
|
helio_dvfsrc_smc(VCOREFS_SMC_CMD_1, spm_flags, 0, 0);
|
||
|
|
}
|
||
|
|
|
||
|
|
inline void spm_dvfs_pwrap_cmd(int pwrap_cmd, int pwrap_vcore)
|
||
|
|
{
|
||
|
|
helio_dvfsrc_smc(VCOREFS_SMC_CMD_3, pwrap_cmd, pwrap_vcore, 0);
|
||
|
|
}
|
||
|
|
|
||
|
|
inline int spm_load_firmware_status(void)
|
||
|
|
{
|
||
|
|
return helio_dvfsrc_firmware_status();
|
||
|
|
}
|
||
|
|
|
||
|
|
inline int spm_get_spmfw_idx(void)
|
||
|
|
{
|
||
|
|
return helio_dvfsrc_spmfw_type();
|
||
|
|
}
|
||
|
|
|