void mt_idle_init(void)
{
int err = 0;
idle_info("[%s]entry!!\n", __func__);
arm_pm_idle = arch_idle;
#ifndef SPM_SUSPEND_GPT_EN
err = request_gpt(GPT4, GPT_ONE_SHOT, GPT_CLK_SRC_SYS, GPT_CLK_DIV_1,
0, NULL, GPT_NOAUTOEN);
if (err) {
idle_info("[%s]fail to request GPT4\n", __func__);
}
#endif
err = sysfs_create_file(power_kobj, &idle_state_attr.attr);
#ifdef SPM_MCDI_FUNC
err |= sysfs_create_file(power_kobj, &mcidle_state_attr.attr);
#endif
err |= sysfs_create_file(power_kobj, &soidle_state_attr.attr);
err |= sysfs_create_file(power_kobj, &dpidle_state_attr.attr);
err |= sysfs_create_file(power_kobj, &rgidle_state_attr.attr);
if (err) {
idle_err("[%s]: fail to create sysfs\n", __func__);
}
}
void mt_idle_init(void)
{
int err = 0;
int i = 0;
idle_info("[%s]entry!!\n", __func__);
arm_pm_idle = arch_idle;
err = request_gpt(idle_gpt, GPT_ONE_SHOT, GPT_CLK_SRC_SYS, GPT_CLK_DIV_1,
0, NULL, GPT_NOAUTOEN);
if (err) {
idle_info("[%s]fail to request GPT%d\n", __func__,idle_gpt+1);
}
err = 0;
for(i=0;i<NR_CPUS;i++){
err |= cpu_xgpt_register_timer(i,NULL);
}
if (err) {
idle_info("[%s]fail to request cpuxgpt\n", __func__);
}
#if defined(CONFIG_PM)
err = sysfs_create_file(power_kobj, &idle_state_attr.attr);
err |= sysfs_create_file(power_kobj, &soidle_state_attr.attr);
err |= sysfs_create_file(power_kobj, &dpidle_state_attr.attr);
err |= sysfs_create_file(power_kobj, &rgidle_state_attr.attr);
if (err) {
idle_err("[%s]: fail to create sysfs\n", __func__);
}
#endif
}
void spm_dpidle_before_wfi(void)
{
int err = 0;
g_clk_aud_intbus_sel = clkmux_get(MT_CLKMUX_AUD_INTBUS_SEL,"Deep_Idle");
clkmux_sel(MT_CLKMUX_AUD_INTBUS_SEL, MT_CG_SYS_26M,"Deep_Idle");
enable_clock(MT_CG_PMIC_SW_CG_AP, "DEEP_IDLE");//PMIC CG bit for AP. SPM need PMIC wrapper clock to change Vcore voltage
#ifdef CONFIG_SMP
free_gpt(GPT4);
err = request_gpt(GPT4, GPT_ONE_SHOT, GPT_CLK_SRC_SYS, GPT_CLK_DIV_1,
0, NULL, GPT_NOAUTOEN);
if (err) {
idle_info("[%s]fail to request GPT4\n", __func__);
}
dpidle_timer_left2 = localtimer_get_counter();
if( dpidle_timer_left2 <=0 )
gpt_set_cmp(GPT4, 1);//Trigger GPT4 Timerout imediately
else
gpt_set_cmp(GPT4, dpidle_timer_left2);
start_gpt(GPT4);
#else
gpt_get_cnt(GPT1, &dpidle_timer_left2);
#endif
}
void soidle_before_wfi(void)
{
#ifdef CONFIG_SMP
int err = 0;
soidle_timer_left2 = localtimer_get_counter();
free_gpt(GPT4);
err = request_gpt(GPT4, GPT_ONE_SHOT, GPT_CLK_SRC_SYS, GPT_CLK_DIV_1,
0, NULL, GPT_NOAUTOEN);
if (err) {
idle_info("[%s]fail to request GPT4\n", __func__);
}
soidle_timer_left2 = localtimer_get_counter();
if( soidle_timer_left2 <=0 )
gpt_set_cmp(GPT4, 1);//Trigger GPT4 Timerout imediately
else
gpt_set_cmp(GPT4, soidle_timer_left2);
start_gpt(GPT4);
#else
gpt_get_cnt(GPT1, &soidle_timer_left2);
#endif
}
void spm_dpidle_after_wfi(void)
{
#if 0
idle_info("[%s]timer_left=%u, timer_left2=%u, delta=%u\n",
dpidle_timer_left, dpidle_timer_left2, dpidle_timer_left-dpidle_timer_left2);
#endif
//if (gpt_check_irq(GPT4)) {
if (gpt_check_and_ack_irq(GPT4)) {
/* waked up by WAKEUP_GPT */
localtimer_set_next_event(1);
} else {
/* waked up by other wakeup source */
unsigned int cnt, cmp;
gpt_get_cnt(GPT4, &cnt);
gpt_get_cmp(GPT4, &cmp);
if (unlikely(cmp < cnt)) {
idle_err("[%s]GPT%d: counter = %10u, compare = %10u\n", __func__,
GPT4 + 1, cnt, cmp);
BUG();
}
localtimer_set_next_event(cmp-cnt);
stop_gpt(GPT4);
//GPT_ClearCount(WAKEUP_GPT);
}
faudintbus_sq2pll();
bus_dcm_disable();
dpidle_cnt[0]++;
}
void soidle_before_wfi(int cpu)
{
int err = 0;
unsigned int id = soidle_gpt_percpu[cpu];
free_gpt(id);
err = request_gpt(id, GPT_ONE_SHOT, GPT_CLK_SRC_SYS, GPT_CLK_DIV_1,
0, NULL, GPT_NOAUTOEN);
if (err) {
idle_info("[%s]fail to request GPT4\n", __func__);
}
soidle_timer_left2[cpu] = localtimer_get_counter();
if( (int)soidle_timer_left2[cpu] <=0 )
{
gpt_set_cmp(id, 1);//Trigger GPT4 Timerout imediately
}
else
gpt_set_cmp(id, soidle_timer_left2[cpu]);
start_gpt(id);
}
void mt_idle_init(void)
{
int err = 0;
idle_info("[%s]entry!!\n", __func__);
arm_pm_idle = arch_idle;
#ifndef SPM_SODI_ENABLED
idle_switch[IDLE_TYPE_SO] = 0;
#endif
//92 deepidle keep use xgpt
err = request_gpt(GPT4, GPT_ONE_SHOT, GPT_CLK_SRC_SYS, GPT_CLK_DIV_1,
0, NULL, GPT_NOAUTOEN);
if (err) {
idle_info("[%s]fail to request GPT4\n", __func__);
}
err = cpu_xgpt_register_timer(0,NULL);
err |= cpu_xgpt_register_timer(1,NULL);
err |= cpu_xgpt_register_timer(2,NULL);
err |= cpu_xgpt_register_timer(3,NULL);
err |= cpu_xgpt_register_timer(4,NULL);
err |= cpu_xgpt_register_timer(5,NULL);
err |= cpu_xgpt_register_timer(6,NULL);
err |= cpu_xgpt_register_timer(7,NULL);
if (err) {
idle_info("[%s]fail to request cpuxgpt\n", __func__);
}
err = sysfs_create_file(power_kobj, &idle_state_attr.attr);
#ifdef SPM_SODI_ENABLED
err |= sysfs_create_file(power_kobj, &soidle_state_attr.attr);
#endif
#ifdef SPM_MCDI_FUNC
err |= sysfs_create_file(power_kobj, &mcidle_state_attr.attr);
#endif
err |= sysfs_create_file(power_kobj, &dpidle_state_attr.attr);
err |= sysfs_create_file(power_kobj, &slidle_state_attr.attr);
err |= sysfs_create_file(power_kobj, &rgidle_state_attr.attr);
if (err) {
idle_err("[%s]: fail to create sysfs\n", __func__);
}
}
void mt_idle_init(void)
{
int err = 0;
int i = 0;
CHIP_SW_VER ver=mt_get_chip_sw_ver();
if(CHIP_SW_VER_02<=ver)
{
memcpy(idle_switch,idle_switch_E2,sizeof(idle_switch));
//return;//TODO,for E2 default off arch_idle
}
idle_info("[%s]entry!!\n", __func__);
arm_pm_idle = arch_idle;
err = request_gpt(idle_gpt, GPT_ONE_SHOT, GPT_CLK_SRC_SYS, GPT_CLK_DIV_1,
0, NULL, GPT_NOAUTOEN);
if (err) {
idle_info("[%s]fail to request GPT%d\n", __func__,idle_gpt+1);
}
err = 0;
for(i=0;i<NR_CPUS;i++){
err |= cpu_xgpt_register_timer(i,NULL);
}
if (err) {
idle_info("[%s]fail to request cpuxgpt\n", __func__);
}
err = sysfs_create_file(power_kobj, &idle_state_attr.attr);
err |= sysfs_create_file(power_kobj, &soidle_state_attr.attr);
err |= sysfs_create_file(power_kobj, &mcidle_state_attr.attr);
err |= sysfs_create_file(power_kobj, &dpidle_state_attr.attr);
err |= sysfs_create_file(power_kobj, &slidle_state_attr.attr);
err |= sysfs_create_file(power_kobj, &rgidle_state_attr.attr);
if (err) {
idle_err("[%s]: fail to create sysfs\n", __func__);
}
}
void enable_dpidle_by_bit(int id)
{
unsigned int grp = clk_id_to_grp_id(id);
unsigned int mask = clk_id_to_mask(id);
if(( grp == NR_GRPS )||( mask == NR_GRPS ))
idle_info("[%s]wrong clock id\n", __func__);
else
dpidle_condition_mask[grp] &= ~mask;
}
void spm_mcdi_before_wfi(int cpu)
{
unsigned int id = mcidle_gpt_percpu[cpu];
if (cpu != 0) {
mcidle_timer_left2[cpu] = localtimer_get_counter();
#ifdef SPM_SUSPEND_GPT_EN
err = request_gpt(id, GPT_ONE_SHOT, GPT_CLK_SRC_SYS, GPT_CLK_DIV_1,
0, NULL, GPT_NOAUTOEN);
if (err) {
idle_info("[%s]fail to request GPT4\n", __func__);
}
#endif
gpt_set_cmp(id, mcidle_timer_left2[cpu]);
start_gpt(id);
}
}
void mcidle_before_wfi(int cpu)
{
#ifdef CONFIG_SMP
int err = 0;
unsigned int id = mcidle_gpt_percpu[cpu];
mcidle_timer_left2[cpu] = localtimer_get_counter();
free_gpt(id);
err = request_gpt(id, GPT_ONE_SHOT, GPT_CLK_SRC_SYS, GPT_CLK_DIV_1,
0, NULL, GPT_NOAUTOEN);
if (err) {
idle_info("[%s]fail to request GPT4\n", __func__);
}
mcidle_timer_left2[cpu] = localtimer_get_counter();
if(cpu!=0)//core1~n, avoid gpt clear by core0
{
if( mcidle_timer_left2[cpu] <=2600 ) //200us(todo)
{
if(mcidle_timer_left2[cpu]<=0)
gpt_set_cmp(id, 1);//Trigger GPT4 Timerout imediately
else
gpt_set_cmp(id, mcidle_timer_left2[cpu]);
spm_write(SPM_SLEEP_CPU_WAKEUP_EVENT,spm_read(SPM_SLEEP_CPU_WAKEUP_EVENT)|0x1);//spm wake up directly
}
else
gpt_set_cmp(id, mcidle_timer_left2[cpu]);
start_gpt(id);
}
#else
gpt_get_cnt(GPT1, &mcidle_timer_left2);
#endif
}