mirror of
https://mirrors.bfsu.edu.cn/git/linux.git
synced 2024-12-16 07:24:39 +08:00
scsi: ufs: ufs-mediatek: Disable MCQ IRQ when clock off
Disable MCQ IRQ when clock is off. This is same as legacy mode. Signed-off-by: Peter Wang <peter.wang@mediatek.com> Link: https://lore.kernel.org/r/20231221110416.16176-4-peter.wang@mediatek.com Reviewed-by: Chun-Hung Wu <chun-hung.wu@mediatek.com> Signed-off-by: Martin K. Petersen <martin.petersen@oracle.com>
This commit is contained in:
parent
468b3e0a3b
commit
e0dc13e5a3
@ -647,6 +647,45 @@ static void ufs_mtk_pwr_ctrl(struct ufs_hba *hba, bool on)
|
||||
}
|
||||
}
|
||||
|
||||
static void ufs_mtk_mcq_disable_irq(struct ufs_hba *hba)
|
||||
{
|
||||
struct ufs_mtk_host *host = ufshcd_get_variant(hba);
|
||||
u32 irq, i;
|
||||
|
||||
if (!is_mcq_enabled(hba))
|
||||
return;
|
||||
|
||||
if (host->mcq_nr_intr == 0)
|
||||
return;
|
||||
|
||||
for (i = 0; i < host->mcq_nr_intr; i++) {
|
||||
irq = host->mcq_intr_info[i].irq;
|
||||
disable_irq(irq);
|
||||
}
|
||||
host->is_mcq_intr_enabled = false;
|
||||
}
|
||||
|
||||
static void ufs_mtk_mcq_enable_irq(struct ufs_hba *hba)
|
||||
{
|
||||
struct ufs_mtk_host *host = ufshcd_get_variant(hba);
|
||||
u32 irq, i;
|
||||
|
||||
if (!is_mcq_enabled(hba))
|
||||
return;
|
||||
|
||||
if (host->mcq_nr_intr == 0)
|
||||
return;
|
||||
|
||||
if (host->is_mcq_intr_enabled == true)
|
||||
return;
|
||||
|
||||
for (i = 0; i < host->mcq_nr_intr; i++) {
|
||||
irq = host->mcq_intr_info[i].irq;
|
||||
enable_irq(irq);
|
||||
}
|
||||
host->is_mcq_intr_enabled = true;
|
||||
}
|
||||
|
||||
/**
|
||||
* ufs_mtk_setup_clocks - enables/disable clocks
|
||||
* @hba: host controller instance
|
||||
@ -690,8 +729,10 @@ static int ufs_mtk_setup_clocks(struct ufs_hba *hba, bool on,
|
||||
|
||||
if (clk_pwr_off)
|
||||
ufs_mtk_pwr_ctrl(hba, false);
|
||||
ufs_mtk_mcq_disable_irq(hba);
|
||||
} else if (on && status == POST_CHANGE) {
|
||||
ufs_mtk_pwr_ctrl(hba, true);
|
||||
ufs_mtk_mcq_enable_irq(hba);
|
||||
}
|
||||
|
||||
return ret;
|
||||
|
@ -183,6 +183,7 @@ struct ufs_mtk_host {
|
||||
u32 ip_ver;
|
||||
|
||||
bool mcq_set_intr;
|
||||
bool is_mcq_intr_enabled;
|
||||
int mcq_nr_intr;
|
||||
struct ufs_mtk_mcq_intr_info mcq_intr_info[UFSHCD_MAX_Q_NR];
|
||||
};
|
||||
|
Loading…
Reference in New Issue
Block a user