mirror of
https://git.kernel.org/pub/scm/linux/kernel/git/stable/linux.git
synced 2024-09-29 22:02:02 +00:00
scsi: ufs: ufs-mediatek: Support low-power mode for parents of VCCQx
Provide the facility to configure parents of VCCQx power rails as low-power or full-power mode in MediaTek UFS platforms. Link: https://lore.kernel.org/r/20220616053725.5681-9-stanley.chu@mediatek.com Signed-off-by: Alice Chao <alice.chao@mediatek.com> Signed-off-by: Stanley Chu <stanley.chu@mediatek.com> Signed-off-by: Martin K. Petersen <martin.petersen@oracle.com>
This commit is contained in:
parent
bc602ae977
commit
42b1928360
2 changed files with 37 additions and 13 deletions
|
@ -1013,10 +1013,30 @@ static int ufs_mtk_link_set_lpm(struct ufs_hba *hba)
|
|||
return 0;
|
||||
}
|
||||
|
||||
static void ufs_mtk_vreg_set_lpm(struct ufs_hba *hba, bool lpm)
|
||||
static void ufs_mtk_vccqx_set_lpm(struct ufs_hba *hba, bool lpm)
|
||||
{
|
||||
struct ufs_vreg *vccqx = NULL;
|
||||
|
||||
if (hba->vreg_info.vccq)
|
||||
vccqx = hba->vreg_info.vccq;
|
||||
else
|
||||
vccqx = hba->vreg_info.vccq2;
|
||||
|
||||
regulator_set_mode(vccqx->reg,
|
||||
lpm ? REGULATOR_MODE_IDLE : REGULATOR_MODE_NORMAL);
|
||||
}
|
||||
|
||||
static void ufs_mtk_vsx_set_lpm(struct ufs_hba *hba, bool lpm)
|
||||
{
|
||||
struct arm_smccc_res res;
|
||||
|
||||
ufs_mtk_device_pwr_ctrl(!lpm,
|
||||
(unsigned long)hba->dev_info.wspecversion,
|
||||
res);
|
||||
}
|
||||
|
||||
static void ufs_mtk_dev_vreg_set_lpm(struct ufs_hba *hba, bool lpm)
|
||||
{
|
||||
if (!hba->vreg_info.vccq && !hba->vreg_info.vccq2)
|
||||
return;
|
||||
|
||||
|
@ -1032,13 +1052,13 @@ static void ufs_mtk_vreg_set_lpm(struct ufs_hba *hba, bool lpm)
|
|||
if (lpm && hba->vreg_info.vcc->enabled)
|
||||
return;
|
||||
|
||||
if (hba->vreg_info.vccq)
|
||||
vccqx = hba->vreg_info.vccq;
|
||||
else
|
||||
vccqx = hba->vreg_info.vccq2;
|
||||
|
||||
regulator_set_mode(vccqx->reg,
|
||||
lpm ? REGULATOR_MODE_IDLE : REGULATOR_MODE_NORMAL);
|
||||
if (lpm) {
|
||||
ufs_mtk_vccqx_set_lpm(hba, lpm);
|
||||
ufs_mtk_vsx_set_lpm(hba, lpm);
|
||||
} else {
|
||||
ufs_mtk_vsx_set_lpm(hba, lpm);
|
||||
ufs_mtk_vccqx_set_lpm(hba, lpm);
|
||||
}
|
||||
}
|
||||
|
||||
static void ufs_mtk_auto_hibern8_disable(struct ufs_hba *hba)
|
||||
|
@ -1105,7 +1125,7 @@ static int ufs_mtk_resume(struct ufs_hba *hba, enum ufs_pm_op pm_op)
|
|||
int err;
|
||||
|
||||
if (hba->ufshcd_state != UFSHCD_STATE_OPERATIONAL)
|
||||
ufs_mtk_vreg_set_lpm(hba, false);
|
||||
ufs_mtk_dev_vreg_set_lpm(hba, false);
|
||||
|
||||
err = ufs_mtk_mphy_power_on(hba, true);
|
||||
if (err)
|
||||
|
@ -1284,7 +1304,7 @@ int ufs_mtk_system_suspend(struct device *dev)
|
|||
if (ret)
|
||||
return ret;
|
||||
|
||||
ufs_mtk_vreg_set_lpm(hba, true);
|
||||
ufs_mtk_dev_vreg_set_lpm(hba, true);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
@ -1293,7 +1313,7 @@ int ufs_mtk_system_resume(struct device *dev)
|
|||
{
|
||||
struct ufs_hba *hba = dev_get_drvdata(dev);
|
||||
|
||||
ufs_mtk_vreg_set_lpm(hba, false);
|
||||
ufs_mtk_dev_vreg_set_lpm(hba, false);
|
||||
|
||||
return ufshcd_system_resume(dev);
|
||||
}
|
||||
|
@ -1307,7 +1327,7 @@ int ufs_mtk_runtime_suspend(struct device *dev)
|
|||
if (ret)
|
||||
return ret;
|
||||
|
||||
ufs_mtk_vreg_set_lpm(hba, true);
|
||||
ufs_mtk_dev_vreg_set_lpm(hba, true);
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
@ -1316,7 +1336,7 @@ int ufs_mtk_runtime_resume(struct device *dev)
|
|||
{
|
||||
struct ufs_hba *hba = dev_get_drvdata(dev);
|
||||
|
||||
ufs_mtk_vreg_set_lpm(hba, false);
|
||||
ufs_mtk_dev_vreg_set_lpm(hba, false);
|
||||
|
||||
return ufshcd_runtime_resume(dev);
|
||||
}
|
||||
|
|
|
@ -83,6 +83,7 @@ enum {
|
|||
#define UFS_MTK_SIP_DEVICE_RESET BIT(1)
|
||||
#define UFS_MTK_SIP_CRYPTO_CTRL BIT(2)
|
||||
#define UFS_MTK_SIP_REF_CLK_NOTIFICATION BIT(3)
|
||||
#define UFS_MTK_SIP_DEVICE_PWR_CTRL BIT(7)
|
||||
|
||||
/*
|
||||
* VS_DEBUGCLOCKENABLE
|
||||
|
@ -182,4 +183,7 @@ static void _ufs_mtk_smc(struct ufs_mtk_smc_arg s)
|
|||
#define ufs_mtk_device_reset_ctrl(high, res) \
|
||||
ufs_mtk_smc(UFS_MTK_SIP_DEVICE_RESET, &(res), high)
|
||||
|
||||
#define ufs_mtk_device_pwr_ctrl(on, ufs_ver, res) \
|
||||
ufs_mtk_smc(UFS_MTK_SIP_DEVICE_PWR_CTRL, &(res), on, ufs_ver)
|
||||
|
||||
#endif /* !_UFS_MEDIATEK_H */
|
||||
|
|
Loading…
Reference in a new issue