mirror of
https://github.com/BobTheBlinker/android_kernel_motorola_sm6375.git
synced 2026-10-13 16:16:15 -04:00
UPSTREAM: scsi: ufs-mediatek: enable low-power mode for hibern8 state
In MediaTek Chipsets, UniPro link and ufshci can enter proprietary low-power mode while link is in hibern8 state. Bug: 149040610 Change-Id: I62a9b8986f25197349211a9d53193e7939bee4eb (cherry picked from commit fdb2c232497296025c27e47d379fe55ba46ff9e6) Link: https://lore.kernel.org/r/20200117035108.19699-4-stanley.chu@mediatek.com Reviewed-by: Alim Akhtar <alim.akhtar@samsung.com> Reviewed-by: Asutosh Das <asutoshd@codeaurora.org> 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
4a7241ffa1
commit
eefb13c9f2
1 changed files with 53 additions and 0 deletions
|
|
@ -382,11 +382,60 @@ static void ufs_mtk_device_reset(struct ufs_hba *hba)
|
|||
dev_info(hba->dev, "device reset done\n");
|
||||
}
|
||||
|
||||
static int ufs_mtk_link_set_hpm(struct ufs_hba *hba)
|
||||
{
|
||||
int err;
|
||||
|
||||
err = ufshcd_hba_enable(hba);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
err = ufshcd_dme_set(hba,
|
||||
UIC_ARG_MIB_SEL(VS_UNIPROPOWERDOWNCONTROL, 0),
|
||||
0);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
err = ufshcd_uic_hibern8_exit(hba);
|
||||
if (!err)
|
||||
ufshcd_set_link_active(hba);
|
||||
else
|
||||
return err;
|
||||
|
||||
err = ufshcd_make_hba_operational(hba);
|
||||
if (err)
|
||||
return err;
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int ufs_mtk_link_set_lpm(struct ufs_hba *hba)
|
||||
{
|
||||
int err;
|
||||
|
||||
err = ufshcd_dme_set(hba,
|
||||
UIC_ARG_MIB_SEL(VS_UNIPROPOWERDOWNCONTROL, 0),
|
||||
1);
|
||||
if (err) {
|
||||
/* Resume UniPro state for following error recovery */
|
||||
ufshcd_dme_set(hba,
|
||||
UIC_ARG_MIB_SEL(VS_UNIPROPOWERDOWNCONTROL, 0),
|
||||
0);
|
||||
return err;
|
||||
}
|
||||
|
||||
return 0;
|
||||
}
|
||||
|
||||
static int ufs_mtk_suspend(struct ufs_hba *hba, enum ufs_pm_op pm_op)
|
||||
{
|
||||
int err;
|
||||
struct ufs_mtk_host *host = ufshcd_get_variant(hba);
|
||||
|
||||
if (ufshcd_is_link_hibern8(hba)) {
|
||||
err = ufs_mtk_link_set_lpm(hba);
|
||||
if (err)
|
||||
return -EAGAIN;
|
||||
phy_power_off(host->mphy);
|
||||
ufs_mtk_setup_ref_clk(hba, false);
|
||||
}
|
||||
|
|
@ -397,10 +446,14 @@ static int ufs_mtk_suspend(struct ufs_hba *hba, enum ufs_pm_op pm_op)
|
|||
static int ufs_mtk_resume(struct ufs_hba *hba, enum ufs_pm_op pm_op)
|
||||
{
|
||||
struct ufs_mtk_host *host = ufshcd_get_variant(hba);
|
||||
int err;
|
||||
|
||||
if (ufshcd_is_link_hibern8(hba)) {
|
||||
ufs_mtk_setup_ref_clk(hba, true);
|
||||
phy_power_on(host->mphy);
|
||||
err = ufs_mtk_link_set_hpm(hba);
|
||||
if (err)
|
||||
return err;
|
||||
}
|
||||
|
||||
return 0;
|
||||
|
|
|
|||
Loading…
Reference in a new issue