Skip to contentSkip to conversation

misc: rtsx: modify and fix init_hw function

PATCH New [email protected] 1 participant 1 message Dec 2, 2020 Char and misc drivers

lore
Share & tools
lore
#0 lore raw

PATCH v2 2/4 misc: rtsx: modify and fix init_hw function

From: Ricky Wu <[email protected]>

changed rtsx_pci_disable_aspm() to rtsx_disable_aspm() do not access ASPM configuration directly

changed pcie_capability_write_word() to _clear_and_set_word() make sure only change PCI_EXP_LNKCTL bit8

make sure ASPM disable after extra_init_hw()

---
 drivers/misc/cardreader/rtsx_pcr.c | 8 +++++---
 1 file changed, 5 insertions(+), 3 deletions(-)
drivers/misc/cardreader/rtsx_pcr.c +5 -3
index c87f791bdcb5..3612063cab09 100644
@@ -1289,7 +1289,7 @@ static int rtsx_pci_init_hw(struct rtsx_pcr *pcr)
 	/* Wait SSC power stable */
 	udelay(200);
 
-	rtsx_pci_disable_aspm(pcr);
+	rtsx_disable_aspm(pcr);
 	if (pcr->ops->optimize_phy) {
 		err = pcr->ops->optimize_phy(pcr);
 		if (err < 0)
@@ -1363,8 +1363,8 @@ static int rtsx_pci_init_hw(struct rtsx_pcr *pcr)
 	rtsx_pci_init_ocp(pcr);
 
 	/* Enable clk_request_n to enable clock power management */
-	pcie_capability_write_word(pdev, PCI_EXP_LNKCTL,
-				   PCI_EXP_LNKCTL_CLKREQ_EN);
+	pcie_capability_clear_and_set_word(pcr->pci, PCI_EXP_LNKCTL,
+					0, PCI_EXP_LNKCTL_CLKREQ_EN);
 	/* Enter L1 when host tx idle */
 	pci_write_config_byte(pdev, 0x70F, 0x5B);
 
@@ -1374,6 +1374,8 @@ static int rtsx_pci_init_hw(struct rtsx_pcr *pcr)
 			return err;
 	}
 
+	rtsx_pci_write_register(pcr, ASPM_FORCE_CTL, 0x30, 0x30);
+
 	/* No CD interrupt if probing driver with card inserted.
 	 * So we need to initialize pcr->card_exist here.
 	 */
Signature · 1 line
2.17.1