PCI: pciehp: Use RMW accessors for changing LNKCTL

As hotplug is not the only driver touching LNKCTL, use the RMW capability
accessor which handles concurrent changes correctly.

Suggested-by: Lukas Wunner <lukas@wunner.de>
Fixes: 7f822999e12a ("PCI: pciehp: Add Disable/enable link functions")
Link: https://lore.kernel.org/r/20230717120503.15276-4-ilpo.jarvinen@linux.intel.com
Signed-off-by: Ilpo Järvinen <ilpo.jarvinen@linux.intel.com>
Signed-off-by: Bjorn Helgaas <bhelgaas@google.com>
Acked-by: "Rafael J. Wysocki" <rafael@kernel.org>

diff --git a/drivers/pci/hotplug/pciehp_hpc.c b/drivers/pci/hotplug/pciehp_hpc.c
index 8711325605f0a537d72fdb5843e353773333d665..fd713abdfb9f9625919aeb52d3aa8f68b26e0f6e 100644 (file)
--- a/drivers/pci/hotplug/pciehp_hpc.c
+++ b/drivers/pci/hotplug/pciehp_hpc.c
@@ -332,17 +332,11 @@ int pciehp_check_link_status(struct controller *ctrl)
 static int __pciehp_link_set(struct controller *ctrl, bool enable)
 {
        struct pci_dev *pdev = ctrl_dev(ctrl);
-       u16 lnk_ctrl;
 
-       pcie_capability_read_word(pdev, PCI_EXP_LNKCTL, &lnk_ctrl);
+       pcie_capability_clear_and_set_word(pdev, PCI_EXP_LNKCTL,
+                                          PCI_EXP_LNKCTL_LD,
+                                          enable ? 0 : PCI_EXP_LNKCTL_LD);
 
-       if (enable)
-               lnk_ctrl &= ~PCI_EXP_LNKCTL_LD;
-       else
-               lnk_ctrl |= PCI_EXP_LNKCTL_LD;
-
-       pcie_capability_write_word(pdev, PCI_EXP_LNKCTL, lnk_ctrl);
-       ctrl_dbg(ctrl, "%s: lnk_ctrl = %x\n", __func__, lnk_ctrl);
        return 0;
 }