Djam/arm-trusted-firmware
1
0
Fork 0
mirror of https://github.com/ARM-software/arm-trusted-firmware.git synced 2025-04-16 09:34:18 +00:00
Code Issues Projects Releases Packages Wiki Activity Actions
arm-trusted-firmware/plat/mediatek/drivers/spm/mt8196/mt_spm_suspend.c
Wenzhen Yu 01ce1d5d2f feat(mt8196): add SPM features support 
When the system is in idle or suspend state, SPM will turn off some
unused system resources. This patch enables this feature to achieve
power saving.

Signed-off-by: Wenzhen Yu <wenzhen.yu@mediatek.com>
Change-Id: Ia9764b91073c4765d41fe7fcd8e4a21372c290f1
2025-01-22 15:28:08 +08:00

711 lines
18 KiB
C
Raw Blame History

/*
* Copyright (c) 2025, Mediatek Inc. All rights reserved.
*
* SPDX-License-Identifier: BSD-3-Clause
*/
#include <stdint.h>
#include <stdio.h>
#include <common/debug.h>
#include <drivers/delay_timer.h>
#include <drivers/gpio.h>
#include <lib/mmio.h>
#include <constraints/mt_spm_rc_internal.h>
#include <drivers/spm/mt_spm_resource_req.h>
#include <lib/pm/mtk_pm.h>
#include <lpm_v2/mt_lp_api.h>
#include <lpm_v2/mt_lp_rqm.h>
#include <mt_spm.h>
#include <mt_spm_conservation.h>
#include <mt_spm_internal.h>
#include <mt_spm_reg.h>
#include <mt_spm_stats.h>
#include <mt_spm_suspend.h>
#if defined(CONFIG_MTK_VCOREDVFS_SUPPORT)
#include <mt_spm_vcorefs_exp.h>
#endif
#define SPM_SUSPEND_SLEEP_PCM_FLAG (SPM_FLAG_DISABLE_DDR_DFS | \
SPM_FLAG_DISABLE_EMI_DFS | \
SPM_FLAG_DISABLE_VLP_PDN | \
SPM_FLAG_DISABLE_BUS_DFS | \
SPM_FLAG_KEEP_CSYSPWRACK_HIGH | \
SPM_FLAG_ENABLE_AOV | \
SPM_FLAG_ENABLE_MD_MUMTAS | \
SPM_FLAG_SRAM_SLEEP_CTRL)
#define SPM_SUSPEND_SLEEP_PCM_FLAG1 (SPM_FLAG1_ENABLE_ALCO_TRACE | \
SPM_FLAG1_ENABLE_SUSPEND_AVS)
#define SPM_SUSPEND_PCM_FLAG (SPM_FLAG_DISABLE_VCORE_DVS | \
SPM_FLAG_DISABLE_MCUPM_PDN | \
SPM_FLAG_DISABLE_VLP_PDN | \
SPM_FLAG_DISABLE_DDR_DFS | \
SPM_FLAG_DISABLE_EMI_DFS | \
SPM_FLAG_DISABLE_BUS_DFS | \
SPM_FLAG_ENABLE_MD_MUMTAS | \
SPM_FLAG_SRAM_SLEEP_CTRL)
#define SPM_SUSPEND_PCM_FLAG1 (SPM_FLAG1_ENABLE_ALCO_TRACE | \
SPM_FLAG1_ENABLE_SUSPEND_AVS | \
SPM_FLAG1_ENABLE_CSOPLU_OFF)
/* Suspend spm power control */
#define __WAKE_SRC_FOR_SUSPEND_COMMON__ ( \
(R12_KP_IRQ_B) | \
(R12_APWDT_EVENT_B) | \
(R12_CONN2AP_WAKEUP_B) | \
(R12_EINT_EVENT_B) | \
(R12_CONN_WDT_IRQ_B) | \
(R12_CCIF0_EVENT_B) | \
(R12_CCIF1_EVENT_B) | \
(R12_SCP2SPM_WAKEUP_B) | \
(R12_ADSP2SPM_WAKEUP_B) | \
(R12_USB0_CDSC_B) | \
(R12_USB0_POWERDWN_B) | \
(R12_UART_EVENT_B) |\
(R12_SYS_TIMER_EVENT_B) | \
(R12_EINT_EVENT_SECURE_B) | \
(R12_SYS_CIRQ_IRQ_B) | \
(R12_MD_WDT_B) | \
(R12_AP2AP_PEER_WAKEUP_B) | \
(R12_CPU_WAKEUP) | \
(R12_APUSYS_WAKE_HOST_B)|\
(R12_PCIE_WAKE_B))
#if defined(CFG_MICROTRUST_TEE_SUPPORT)
#define WAKE_SRC_FOR_SUSPEND \
(__WAKE_SRC_FOR_SUSPEND_COMMON__)
#else
#define WAKE_SRC_FOR_SUSPEND \
(__WAKE_SRC_FOR_SUSPEND_COMMON__ | \
R12_SEJ_B)
#endif
static uint32_t gpio_bk1;
static uint32_t gpio_bk2;
static uint32_t gpio_bk3;
static struct pwr_ctrl suspend_ctrl = {
.wake_src = WAKE_SRC_FOR_SUSPEND,
/* SPM_SRC_REQ */
.reg_spm_adsp_mailbox_req = 0,
.reg_spm_apsrc_req = 0,
.reg_spm_ddren_req = 0,
.reg_spm_dvfs_req = 0,
.reg_spm_emi_req = 0,
.reg_spm_f26m_req = 0,
.reg_spm_infra_req = 0,
.reg_spm_pmic_req = 0,
.reg_spm_scp_mailbox_req = 0,
.reg_spm_sspm_mailbox_req = 0,
.reg_spm_sw_mailbox_req = 0,
.reg_spm_vcore_req = 1,
.reg_spm_vrf18_req = 0,
.adsp_mailbox_state = 0,
.apsrc_state = 0,
.ddren_state = 0,
.dvfs_state = 0,
.emi_state = 0,
.f26m_state = 0,
.infra_state = 0,
.pmic_state = 0,
.scp_mailbox_state = 0,
.sspm_mailbox_state = 0,
.sw_mailbox_state = 0,
.vcore_state = 0,
.vrf18_state = 0,
/* SPM_SRC_MASK_0 */
.reg_apifr_apsrc_rmb = 0,
.reg_apifr_ddren_rmb = 0,
.reg_apifr_emi_rmb = 0,
.reg_apifr_infra_rmb = 0,
.reg_apifr_pmic_rmb = 0,
.reg_apifr_srcclkena_mb = 0,
.reg_apifr_vcore_rmb = 0,
.reg_apifr_vrf18_rmb = 0,
.reg_apu_apsrc_rmb = 1,
.reg_apu_ddren_rmb = 0,
.reg_apu_emi_rmb = 1,
.reg_apu_infra_rmb = 1,
.reg_apu_pmic_rmb = 1,
.reg_apu_srcclkena_mb = 1,
.reg_apu_vcore_rmb = 1,
.reg_apu_vrf18_rmb = 1,
.reg_audio_apsrc_rmb = 1,
.reg_audio_ddren_rmb = 0,
.reg_audio_emi_rmb = 1,
.reg_audio_infra_rmb = 1,
.reg_audio_pmic_rmb = 0,
.reg_audio_srcclkena_mb = 1,
.reg_audio_vcore_rmb = 1,
.reg_audio_vrf18_rmb = 1,
/* SPM_SRC_MASK_1 */
.reg_audio_dsp_apsrc_rmb = 1,
.reg_audio_dsp_ddren_rmb = 0,
.reg_audio_dsp_emi_rmb = 1,
.reg_audio_dsp_infra_rmb = 1,
.reg_audio_dsp_pmic_rmb = 1,
.reg_audio_dsp_srcclkena_mb = 1,
.reg_audio_dsp_vcore_rmb = 1,
.reg_audio_dsp_vrf18_rmb = 1,
.reg_cam_apsrc_rmb = 0,
.reg_cam_ddren_rmb = 0,
.reg_cam_emi_rmb = 0,
.reg_cam_infra_rmb = 0,
.reg_cam_pmic_rmb = 0,
.reg_cam_srcclkena_mb = 0,
.reg_cam_vrf18_rmb = 0,
.reg_ccif_apsrc_rmb = 0xfff,
/* SPM_SRC_MASK_2 */
.reg_ccif_emi_rmb = 0xfff,
.reg_ccif_infra_rmb = 0xfff,
/* SPM_SRC_MASK_3 */
.reg_ccif_pmic_rmb = 0xfff,
.reg_ccif_srcclkena_mb = 0xfff,
/* SPM_SRC_MASK_4 */
.reg_ccif_vcore_rmb = 0xfff,
.reg_ccif_vrf18_rmb = 0xfff,
.reg_ccu_apsrc_rmb = 0,
.reg_ccu_ddren_rmb = 0,
.reg_ccu_emi_rmb = 0,
.reg_ccu_infra_rmb = 0,
.reg_ccu_pmic_rmb = 0,
.reg_ccu_srcclkena_mb = 0,
.reg_ccu_vrf18_rmb = 0,
.reg_cg_check_apsrc_rmb = 0,
/* SPM_SRC_MASK_5 */
.reg_cg_check_ddren_rmb = 0,
.reg_cg_check_emi_rmb = 0,
.reg_cg_check_infra_rmb = 0,
.reg_cg_check_pmic_rmb = 0,
.reg_cg_check_srcclkena_mb = 0,
.reg_cg_check_vcore_rmb = 1,
.reg_cg_check_vrf18_rmb = 0,
.reg_cksys_apsrc_rmb = 1,
.reg_cksys_ddren_rmb = 0,
.reg_cksys_emi_rmb = 1,
.reg_cksys_infra_rmb = 1,
.reg_cksys_pmic_rmb = 1,
.reg_cksys_srcclkena_mb = 1,
.reg_cksys_vcore_rmb = 1,
.reg_cksys_vrf18_rmb = 1,
.reg_cksys_1_apsrc_rmb = 1,
.reg_cksys_1_ddren_rmb = 0,
.reg_cksys_1_emi_rmb = 1,
.reg_cksys_1_infra_rmb = 1,
.reg_cksys_1_pmic_rmb = 1,
.reg_cksys_1_srcclkena_mb = 1,
.reg_cksys_1_vcore_rmb = 1,
.reg_cksys_1_vrf18_rmb = 1,
/* SPM_SRC_MASK_6 */
.reg_cksys_2_apsrc_rmb = 1,
.reg_cksys_2_ddren_rmb = 0,
.reg_cksys_2_emi_rmb = 1,
.reg_cksys_2_infra_rmb = 1,
.reg_cksys_2_pmic_rmb = 1,
.reg_cksys_2_srcclkena_mb = 1,
.reg_cksys_2_vcore_rmb = 1,
.reg_cksys_2_vrf18_rmb = 1,
.reg_conn_apsrc_rmb = 1,
.reg_conn_ddren_rmb = 0,
.reg_conn_emi_rmb = 1,
.reg_conn_infra_rmb = 1,
.reg_conn_pmic_rmb = 1,
.reg_conn_srcclkena_mb = 1,
.reg_conn_srcclkenb_mb = 1,
.reg_conn_vcore_rmb = 1,
.reg_conn_vrf18_rmb = 1,
.reg_corecfg_apsrc_rmb = 0,
.reg_corecfg_ddren_rmb = 0,
.reg_corecfg_emi_rmb = 0,
.reg_corecfg_infra_rmb = 0,
.reg_corecfg_pmic_rmb = 0,
.reg_corecfg_srcclkena_mb = 0,
.reg_corecfg_vcore_rmb = 0,
.reg_corecfg_vrf18_rmb = 0,
/* SPM_SRC_MASK_7 */
.reg_cpueb_apsrc_rmb = 1,
.reg_cpueb_ddren_rmb = 0,
.reg_cpueb_emi_rmb = 1,
.reg_cpueb_infra_rmb = 1,
.reg_cpueb_pmic_rmb = 1,
.reg_cpueb_srcclkena_mb = 1,
.reg_cpueb_vcore_rmb = 0,
.reg_cpueb_vrf18_rmb = 1,
.reg_disp0_apsrc_rmb = 0,
.reg_disp0_ddren_rmb = 0,
.reg_disp0_emi_rmb = 0,
.reg_disp0_infra_rmb = 0,
.reg_disp0_pmic_rmb = 0,
.reg_disp0_srcclkena_mb = 0,
.reg_disp0_vrf18_rmb = 0,
.reg_disp1_apsrc_rmb = 0,
.reg_disp1_ddren_rmb = 0,
.reg_disp1_emi_rmb = 0,
.reg_disp1_infra_rmb = 0,
.reg_disp1_pmic_rmb = 0,
.reg_disp1_srcclkena_mb = 0,
.reg_disp1_vrf18_rmb = 0,
.reg_dpm_apsrc_rmb = 0xf,
.reg_dpm_ddren_rmb = 0xf,
/* SPM_SRC_MASK_8 */
.reg_dpm_emi_rmb = 0xf,
.reg_dpm_infra_rmb = 0xf,
.reg_dpm_pmic_rmb = 0xf,
.reg_dpm_srcclkena_mb = 0xf,
.reg_dpm_vcore_rmb = 0xf,
.reg_dpm_vrf18_rmb = 0xf,
.reg_dpmaif_apsrc_rmb = 1,
.reg_dpmaif_ddren_rmb = 0,
.reg_dpmaif_emi_rmb = 1,
.reg_dpmaif_infra_rmb = 1,
.reg_dpmaif_pmic_rmb = 1,
.reg_dpmaif_srcclkena_mb = 1,
.reg_dpmaif_vcore_rmb = 1,
.reg_dpmaif_vrf18_rmb = 1,
/* SPM_SRC_MASK_9 */
.reg_dvfsrc_level_rmb = 1,
.reg_emisys_apsrc_rmb = 0,
.reg_emisys_ddren_rmb = 0,
.reg_emisys_emi_rmb = 0,
.reg_emisys_infra_rmb = 0,
.reg_emisys_pmic_rmb = 0,
.reg_emisys_srcclkena_mb = 0,
.reg_emisys_vcore_rmb = 0,
.reg_emisys_vrf18_rmb = 0,
.reg_gce_apsrc_rmb = 0,
.reg_gce_ddren_rmb = 0,
.reg_gce_emi_rmb = 0,
.reg_gce_infra_rmb = 0,
.reg_gce_pmic_rmb = 0,
.reg_gce_srcclkena_mb = 0,
.reg_gce_vcore_rmb = 0,
.reg_gce_vrf18_rmb = 0,
.reg_gpueb_apsrc_rmb = 1,
.reg_gpueb_ddren_rmb = 0,
.reg_gpueb_emi_rmb = 1,
.reg_gpueb_infra_rmb = 1,
.reg_gpueb_pmic_rmb = 1,
.reg_gpueb_srcclkena_mb = 1,
.reg_gpueb_vcore_rmb = 1,
.reg_gpueb_vrf18_rmb = 1,
.reg_hwccf_apsrc_rmb = 1,
.reg_hwccf_ddren_rmb = 0,
.reg_hwccf_emi_rmb = 1,
.reg_hwccf_infra_rmb = 1,
.reg_hwccf_pmic_rmb = 1,
.reg_hwccf_srcclkena_mb = 1,
.reg_hwccf_vcore_rmb = 1,
/* SPM_SRC_MASK_10 */
.reg_hwccf_vrf18_rmb = 1,
.reg_img_apsrc_rmb = 0,
.reg_img_ddren_rmb = 0,
.reg_img_emi_rmb = 0,
.reg_img_infra_rmb = 0,
.reg_img_pmic_rmb = 0,
.reg_img_srcclkena_mb = 0,
.reg_img_vrf18_rmb = 0,
.reg_infrasys_apsrc_rmb = 0,
.reg_infrasys_ddren_rmb = 0,
.reg_infrasys_emi_rmb = 0,
.reg_infrasys_infra_rmb = 0,
.reg_infrasys_pmic_rmb = 0,
.reg_infrasys_srcclkena_mb = 0,
.reg_infrasys_vcore_rmb = 0,
.reg_infrasys_vrf18_rmb = 0,
.reg_ipic_infra_rmb = 1,
.reg_ipic_vrf18_rmb = 1,
.reg_mcu_apsrc_rmb = 1,
.reg_mcu_ddren_rmb = 0,
.reg_mcu_emi_rmb = 1,
.reg_mcu_infra_rmb = 1,
.reg_mcu_pmic_rmb = 1,
.reg_mcu_srcclkena_mb = 1,
.reg_mcu_vcore_rmb = 0,
.reg_mcu_vrf18_rmb = 1,
.reg_md_apsrc_rmb = 1,
.reg_md_ddren_rmb = 0,
.reg_md_emi_rmb = 1,
.reg_md_infra_rmb = 1,
.reg_md_pmic_rmb = 1,
.reg_md_srcclkena_mb = 1,
/* SPM_SRC_MASK_11 */
.reg_md_srcclkena1_mb = 1,
.reg_md_vcore_rmb = 1,
.reg_md_vrf18_rmb = 1,
.reg_mm_proc_apsrc_rmb = 1,
.reg_mm_proc_ddren_rmb = 0,
.reg_mm_proc_emi_rmb = 1,
.reg_mm_proc_infra_rmb = 1,
.reg_mm_proc_pmic_rmb = 1,
.reg_mm_proc_srcclkena_mb = 1,
.reg_mm_proc_vcore_rmb = 1,
.reg_mm_proc_vrf18_rmb = 1,
.reg_mml0_apsrc_rmb = 0,
.reg_mml0_ddren_rmb = 0,
.reg_mml0_emi_rmb = 0,
.reg_mml0_infra_rmb = 0,
.reg_mml0_pmic_rmb = 0,
.reg_mml0_srcclkena_mb = 0,
.reg_mml0_vrf18_rmb = 0,
.reg_mml1_apsrc_rmb = 0,
.reg_mml1_ddren_rmb = 0,
.reg_mml1_emi_rmb = 0,
.reg_mml1_infra_rmb = 0,
.reg_mml1_pmic_rmb = 0,
.reg_mml1_srcclkena_mb = 0,
.reg_mml1_vrf18_rmb = 0,
.reg_ovl0_apsrc_rmb = 0,
.reg_ovl0_ddren_rmb = 0,
.reg_ovl0_emi_rmb = 0,
.reg_ovl0_infra_rmb = 0,
.reg_ovl0_pmic_rmb = 0,
.reg_ovl0_srcclkena_mb = 0,
.reg_ovl0_vrf18_rmb = 0,
/* SPM_SRC_MASK_12 */
.reg_ovl1_apsrc_rmb = 0,
.reg_ovl1_ddren_rmb = 0,
.reg_ovl1_emi_rmb = 0,
.reg_ovl1_infra_rmb = 0,
.reg_ovl1_pmic_rmb = 0,
.reg_ovl1_srcclkena_mb = 0,
.reg_ovl1_vrf18_rmb = 0,
.reg_pcie0_apsrc_rmb = 1,
.reg_pcie0_ddren_rmb = 0,
.reg_pcie0_emi_rmb = 1,
.reg_pcie0_infra_rmb = 1,
.reg_pcie0_pmic_rmb = 1,
.reg_pcie0_srcclkena_mb = 1,
.reg_pcie0_vcore_rmb = 1,
.reg_pcie0_vrf18_rmb = 1,
.reg_pcie1_apsrc_rmb = 1,
.reg_pcie1_ddren_rmb = 0,
.reg_pcie1_emi_rmb = 1,
.reg_pcie1_infra_rmb = 1,
.reg_pcie1_pmic_rmb = 1,
.reg_pcie1_srcclkena_mb = 1,
.reg_pcie1_vcore_rmb = 1,
.reg_pcie1_vrf18_rmb = 1,
.reg_perisys_apsrc_rmb = 1,
.reg_perisys_ddren_rmb = 0,
.reg_perisys_emi_rmb = 1,
.reg_perisys_infra_rmb = 1,
.reg_perisys_pmic_rmb = 1,
.reg_perisys_srcclkena_mb = 1,
.reg_perisys_vcore_rmb = 1,
.reg_perisys_vrf18_rmb = 1,
.reg_pmsr_apsrc_rmb = 1,
/* SPM_SRC_MASK_13 */
.reg_pmsr_ddren_rmb = 0,
.reg_pmsr_emi_rmb = 1,
.reg_pmsr_infra_rmb = 1,
.reg_pmsr_pmic_rmb = 1,
.reg_pmsr_srcclkena_mb = 1,
.reg_pmsr_vcore_rmb = 1,
.reg_pmsr_vrf18_rmb = 1,
.reg_scp_apsrc_rmb = 1,
.reg_scp_ddren_rmb = 0,
.reg_scp_emi_rmb = 1,
.reg_scp_infra_rmb = 1,
.reg_scp_pmic_rmb = 1,
.reg_scp_srcclkena_mb = 1,
.reg_scp_vcore_rmb = 1,
.reg_scp_vrf18_rmb = 1,
.reg_spu_hwr_apsrc_rmb = 1,
.reg_spu_hwr_ddren_rmb = 0,
.reg_spu_hwr_emi_rmb = 1,
.reg_spu_hwr_infra_rmb = 1,
.reg_spu_hwr_pmic_rmb = 1,
.reg_spu_hwr_srcclkena_mb = 1,
.reg_spu_hwr_vcore_rmb = 1,
.reg_spu_hwr_vrf18_rmb = 1,
.reg_spu_ise_apsrc_rmb = 1,
.reg_spu_ise_ddren_rmb = 0,
.reg_spu_ise_emi_rmb = 1,
.reg_spu_ise_infra_rmb = 1,
.reg_spu_ise_pmic_rmb = 1,
.reg_spu_ise_srcclkena_mb = 1,
.reg_spu_ise_vcore_rmb = 1,
.reg_spu_ise_vrf18_rmb = 1,
/* SPM_SRC_MASK_14 */
.reg_srcclkeni_infra_rmb = 0x3,
.reg_srcclkeni_pmic_rmb = 0x3,
.reg_srcclkeni_srcclkena_mb = 0x3,
.reg_srcclkeni_vcore_rmb = 0x3,
.reg_sspm_apsrc_rmb = 1,
.reg_sspm_ddren_rmb = 0,
.reg_sspm_emi_rmb = 1,
.reg_sspm_infra_rmb = 1,
.reg_sspm_pmic_rmb = 1,
.reg_sspm_srcclkena_mb = 1,
.reg_sspm_vrf18_rmb = 1,
.reg_ssrsys_apsrc_rmb = 1,
.reg_ssrsys_ddren_rmb = 0,
.reg_ssrsys_emi_rmb = 1,
.reg_ssrsys_infra_rmb = 1,
.reg_ssrsys_pmic_rmb = 1,
.reg_ssrsys_srcclkena_mb = 1,
.reg_ssrsys_vcore_rmb = 1,
.reg_ssrsys_vrf18_rmb = 1,
.reg_ssusb_apsrc_rmb = 1,
.reg_ssusb_ddren_rmb = 0,
.reg_ssusb_emi_rmb = 1,
.reg_ssusb_infra_rmb = 1,
.reg_ssusb_pmic_rmb = 1,
.reg_ssusb_srcclkena_mb = 1,
.reg_ssusb_vcore_rmb = 1,
.reg_ssusb_vrf18_rmb = 1,
.reg_uart_hub_infra_rmb = 1,
/* SPM_SRC_MASK_15 */
.reg_uart_hub_pmic_rmb = 1,
.reg_uart_hub_srcclkena_mb = 1,
.reg_uart_hub_vcore_rmb = 1,
.reg_uart_hub_vrf18_rmb = 1,
.reg_ufs_apsrc_rmb = 1,
.reg_ufs_ddren_rmb = 0,
.reg_ufs_emi_rmb = 1,
.reg_ufs_infra_rmb = 1,
.reg_ufs_pmic_rmb = 1,
.reg_ufs_srcclkena_mb = 1,
.reg_ufs_vcore_rmb = 1,
.reg_ufs_vrf18_rmb = 1,
.reg_vdec_apsrc_rmb = 0,
.reg_vdec_ddren_rmb = 0,
.reg_vdec_emi_rmb = 0,
.reg_vdec_infra_rmb = 0,
.reg_vdec_pmic_rmb = 0,
.reg_vdec_srcclkena_mb = 0,
.reg_vdec_vrf18_rmb = 0,
.reg_venc_apsrc_rmb = 0,
.reg_venc_ddren_rmb = 0,
.reg_venc_emi_rmb = 0,
.reg_venc_infra_rmb = 0,
.reg_venc_pmic_rmb = 0,
.reg_venc_srcclkena_mb = 0,
.reg_venc_vrf18_rmb = 0,
.reg_vlpcfg_apsrc_rmb = 1,
.reg_vlpcfg_ddren_rmb = 0,
.reg_vlpcfg_emi_rmb = 1,
.reg_vlpcfg_infra_rmb = 1,
.reg_vlpcfg_pmic_rmb = 1,
.reg_vlpcfg_srcclkena_mb = 1,
/* SPM_SRC_MASK_16 */
.reg_vlpcfg_vcore_rmb = 1,
.reg_vlpcfg_vrf18_rmb = 1,
.reg_vlpcfg1_apsrc_rmb = 1,
.reg_vlpcfg1_ddren_rmb = 0,
.reg_vlpcfg1_emi_rmb = 1,
.reg_vlpcfg1_infra_rmb = 1,
.reg_vlpcfg1_pmic_rmb = 0,
.reg_vlpcfg1_srcclkena_mb = 1,
.reg_vlpcfg1_vcore_rmb = 1,
.reg_vlpcfg1_vrf18_rmb = 1,
/* SPM_EVENT_CON_MISC */
.reg_srcclken_fast_resp = 0,
.reg_csyspwrup_ack_mask = 1,
/* SPM_SRC_MASK_17 */
.reg_spm_sw_vcore_rmb = 0x3,
.reg_spm_sw_pmic_rmb = 0,
/* SPM_SRC_MASK_18 */
.reg_spm_sw_srcclkena_mb = 0,
/* SPM_WAKE_MASK*/
.reg_wake_mask = 0x81322012,
/* SPM_WAKEUP_EVENT_EXT_MASK */
.reg_ext_wake_mask = 0xFFFFFFFF,
/*SW flag setting */
.pcm_flags = SPM_SUSPEND_PCM_FLAG,
.pcm_flags1 = SPM_SUSPEND_PCM_FLAG1,
};
static struct suspend_dbg_ctrl suspend_spm_dbg_ext = {
.sleep_suspend_cnt = 0,
};
static struct dbg_ctrl suspend_spm_dbg = {
.count = 0,
.duration = 0,
.ext = &suspend_spm_dbg_ext,
};
static struct spm_lp_stat suspend_lp_stat;
struct spm_lp_scen __spm_suspend = {
.pwrctrl = &suspend_ctrl,
.dbgctrl = &suspend_spm_dbg,
.lpstat = &suspend_lp_stat,
};
static uint8_t bak_spm_vcore_req;
int mt_spm_suspend_mode_set(enum mt_spm_suspend_mode mode, void *prv)
{
if (mode == MT_SPM_SUSPEND_SLEEP) {
suspend_ctrl.pcm_flags = SPM_SUSPEND_SLEEP_PCM_FLAG;
suspend_ctrl.pcm_flags1 = SPM_SUSPEND_SLEEP_PCM_FLAG1;
suspend_ctrl.reg_spm_vcore_req = 1;
} else {
suspend_ctrl.pcm_flags = SPM_SUSPEND_PCM_FLAG;
suspend_ctrl.pcm_flags1 = SPM_SUSPEND_PCM_FLAG1;
}
return 0;
}
static void spm_CSOPLU_ctrl_leave_suspend(void)
{
mmio_setbits_32(SPM_RSV_CSOPLU_REQ, (0x1));
}
static void mt_spm_suspend_ec_pin(void)
{
gpio_bk1 = mmio_read_32(MODE_BACKUP_REG);
gpio_bk2 = mmio_read_32(DIR_BACKUP_REG);
gpio_bk3 = mmio_read_32(DOUT_BACKUP_REG);
mmio_write_32(MODE_SET, SET_GPIO_MODE);
gpio_set_direction(EC_SUSPEND_BK_PIN, GPIO_DIR_OUT);
/* GPIO111 LOW */
gpio_set_value(EC_SUSPEND_BK_PIN, GPIO_LEVEL_LOW);
/* GPIO38 LOW */
gpio_set_value(EC_SUSPEND_PIN, GPIO_LEVEL_LOW);
}
static void mt_spm_resume_ec_pin(void)
{
/* GPIO38 HIGH */
gpio_set_value(EC_SUSPEND_PIN, GPIO_LEVEL_HIGH);
/* GPIO111 HIGH */
gpio_set_value(EC_SUSPEND_BK_PIN, GPIO_LEVEL_HIGH);
udelay(10);
mmio_write_32(MODE_BACKUP_REG, gpio_bk1);
mmio_write_32(DIR_BACKUP_REG, gpio_bk2);
mmio_write_32(DOUT_BACKUP_REG, gpio_bk3);
}
int mt_spm_suspend_enter(int state_id,
uint32_t ext_opand, uint32_t resource_req)
{
int ret = 0;
bak_spm_vcore_req = suspend_ctrl.reg_spm_vcore_req;
/* if FMAudio, ADSP, USB headset is active, change to sleep mode */
if (ext_opand & MT_SPM_EX_OP_SET_SUSPEND_MODE)
mt_spm_suspend_mode_set(MT_SPM_SUSPEND_SLEEP,
&resource_req);
else
mt_spm_suspend_mode_set(MT_SPM_SUSPEND_SYSTEM_PDN,
&resource_req);
mmio_write_32(SPM2SW_MAILBOX_0, 0x1);
ext_opand |= MT_SPM_EX_OP_DEVICES_SAVE;
#if defined(CONFIG_MTK_VCOREDVFS_SUPPORT)
/* Notify vcoredvfs suspend enter */
spm_vcorefs_plat_suspend();
#endif
ret = spm_conservation(state_id, ext_opand,
&__spm_suspend, resource_req);
if (ret == 0) {
struct mt_lp_publish_event event = {
.id = MT_LPM_PUBEVENTS_SYS_POWER_OFF,
.val.u32 = 0,
.level = MT_LP_SYSPOWER_LEVEL_SUSPEND,
};
MT_LP_SUSPEND_PUBLISH_EVENT(&event);
}
mt_spm_suspend_ec_pin();
return ret;
}
void mt_spm_suspend_resume(int state_id, uint32_t ext_opand,
struct wake_status **status)
{
struct mt_lp_publish_event event;
struct wake_status *st = NULL;
ext_opand |= MT_SPM_EX_OP_DEVICES_SAVE;
mt_spm_resume_ec_pin();
spm_conservation_finish(state_id, ext_opand, &__spm_suspend, &st);
spm_CSOPLU_ctrl_leave_suspend();
mt_spm_update_lp_stat(&suspend_lp_stat);
#if defined(CONFIG_MTK_VCOREDVFS_SUPPORT)
/* Notify vcoredvfs suspend enter */
spm_vcorefs_plat_resume();
mmio_write_32(SPM2SW_MAILBOX_0, 0x0);
#endif
/*****************************************
* If FMAudio, ADSP, USB headset is active,
* change back to suspend mode and counting in resume
*****************************************/
if (ext_opand & MT_SPM_EX_OP_SET_SUSPEND_MODE) {
mt_spm_suspend_mode_set(MT_SPM_SUSPEND_SYSTEM_PDN, NULL);
suspend_spm_dbg_ext.sleep_suspend_cnt += 1;
}
suspend_ctrl.reg_spm_vcore_req = bak_spm_vcore_req;
suspend_spm_dbg.count += 1;
event.id = MT_LPM_PUBEVENTS_SYS_POWER_ON;
event.val.u32 = 0;
event.level = MT_LP_SYSPOWER_LEVEL_SUSPEND;
if (st) {
if (st->tr.comm.r12 & R12_AP2AP_PEER_WAKEUP_B)
event.val.u32 = MT_LPM_WAKE_MD_WAKEUP_DPMAIF;
if (st->tr.comm.r12 & R12_CCIF0_EVENT_B)
event.val.u32 = MT_LPM_WAKE_MD_WAKEUP_CCIF0;
if (st->tr.comm.r12 & R12_CCIF1_EVENT_B)
event.val.u32 = MT_LPM_WAKE_MD_WAKEUP_CCIF1;
}
if (status)
*status = st;
MT_LP_SUSPEND_PUBLISH_EVENT(&event);
}
int mt_spm_suspend_get_spm_lp(struct spm_lp_scen **lp)
{
if (!lp)
return -1;
*lp = &__spm_suspend;
return 0;
}
Reference in a new issue View git blame Copy permalink