PCI/pwrctrl: Add APIs to power on/off pwrctrl devices

To fix bridge resource allocation issues when powering PCI bridges with the
pwrctrl driver, introduce APIs to explicitly power on and off all related
devices simultaneously.

Previously, the individual pwrctrl drivers powered on/off the PCI devices
autonomously, without any control from the controller drivers. But to
enforce ordering with respect to powering on the devices, these APIs will
power on/off all the devices at the same time.

The pci_pwrctrl_power_on_devices() API recursively scans the PCI child
nodes, makes sure that pwrctrl drivers are bound to devices, and calls
their power_on() callbacks. If any pwrctrl driver is not bound, it will
return -EPROBE_DEFER.

Similarly, pci_pwrctrl_power_off_devices() API powers off devices
recursively via their power_off() callbacks.

These APIs are expected to be called during the controller probe and
suspend/resume time to power on/off the devices. But before calling these
APIs, the pwrctrl devices should be created using the
pci_pwrctrl_{create/destroy}_devices() APIs.

Co-developed-by: Krishna Chaitanya Chundru <krishna.chundru@oss.qualcomm.com>
Signed-off-by: Krishna Chaitanya Chundru <krishna.chundru@oss.qualcomm.com>
Signed-off-by: Manivannan Sadhasivam <manivannan.sadhasivam@oss.qualcomm.com>
Signed-off-by: Bjorn Helgaas <bhelgaas@google.com>
Tested-by: Chen-Yu Tsai <wenst@chromium.org>
Reviewed-by: Bartosz Golaszewski <bartosz.golaszewski@linaro.org>
Link: https://patch.msgid.link/20260115-pci-pwrctrl-rework-v5-11-9d26da3ce903@oss.qualcomm.com

diff --git a/drivers/pci/pwrctrl/core.c b/drivers/pci/pwrctrl/core.c
index b423768cc477c96e025582a744b75afdd2f0c0d5..fef5243d9445857e9339558d54e9b27d13895e37 100644 (file)
--- a/drivers/pci/pwrctrl/core.c
+++ b/drivers/pci/pwrctrl/core.c
@@ -65,6 +65,7 @@ void pci_pwrctrl_init(struct pci_pwrctrl *pwrctrl, struct device *dev)
 {
        pwrctrl->dev = dev;
        INIT_WORK(&pwrctrl->work, rescan_work_func);
+       dev_set_drvdata(dev, pwrctrl);
 }
 EXPORT_SYMBOL_GPL(pci_pwrctrl_init);
 
@@ -152,6 +153,135 @@ int devm_pci_pwrctrl_device_set_ready(struct device *dev,
 }
 EXPORT_SYMBOL_GPL(devm_pci_pwrctrl_device_set_ready);
 
+static int __pci_pwrctrl_power_off_device(struct device *dev)
+{
+       struct pci_pwrctrl *pwrctrl = dev_get_drvdata(dev);
+
+       if (!pwrctrl)
+               return 0;
+
+       return pwrctrl->power_off(pwrctrl);
+}
+
+static void pci_pwrctrl_power_off_device(struct device_node *np)
+{
+       struct platform_device *pdev;
+       int ret;
+
+       for_each_available_child_of_node_scoped(np, child)
+               pci_pwrctrl_power_off_device(child);
+
+       pdev = of_find_device_by_node(np);
+       if (!pdev)
+               return;
+
+       if (device_is_bound(&pdev->dev)) {
+               ret = __pci_pwrctrl_power_off_device(&pdev->dev);
+               if (ret)
+                       dev_err(&pdev->dev, "Failed to power off device: %d", ret);
+       }
+
+       platform_device_put(pdev);
+}
+
+/**
+ * pci_pwrctrl_power_off_devices - Power off pwrctrl devices
+ *
+ * @parent: PCI host controller device
+ *
+ * Recursively traverse all pwrctrl devices for the devicetree hierarchy
+ * below the specified PCI host controller and power them off in a depth
+ * first manner.
+ */
+void pci_pwrctrl_power_off_devices(struct device *parent)
+{
+       struct device_node *np = parent->of_node;
+
+       for_each_available_child_of_node_scoped(np, child)
+               pci_pwrctrl_power_off_device(child);
+}
+EXPORT_SYMBOL_GPL(pci_pwrctrl_power_off_devices);
+
+static int __pci_pwrctrl_power_on_device(struct device *dev)
+{
+       struct pci_pwrctrl *pwrctrl = dev_get_drvdata(dev);
+
+       if (!pwrctrl)
+               return 0;
+
+       return pwrctrl->power_on(pwrctrl);
+}
+
+/*
+ * Power on the devices in a depth first manner. Before powering on the device,
+ * make sure its driver is bound.
+ */
+static int pci_pwrctrl_power_on_device(struct device_node *np)
+{
+       struct platform_device *pdev;
+       int ret;
+
+       for_each_available_child_of_node_scoped(np, child) {
+               ret = pci_pwrctrl_power_on_device(child);
+               if (ret)
+                       return ret;
+       }
+
+       pdev = of_find_device_by_node(np);
+       if (!pdev)
+               return 0;
+
+       if (device_is_bound(&pdev->dev)) {
+               ret = __pci_pwrctrl_power_on_device(&pdev->dev);
+       } else {
+               /* FIXME: Use blocking wait instead of probe deferral */
+               dev_dbg(&pdev->dev, "driver is not bound\n");
+               ret = -EPROBE_DEFER;
+       }
+
+       platform_device_put(pdev);
+
+       return ret;
+}
+
+/**
+ * pci_pwrctrl_power_on_devices - Power on pwrctrl devices
+ *
+ * @parent: PCI host controller device
+ *
+ * Recursively traverse all pwrctrl devices for the devicetree hierarchy
+ * below the specified PCI host controller and power them on in a depth
+ * first manner. On error, all powered on devices will be powered off.
+ *
+ * Return: 0 on success, -EPROBE_DEFER if any pwrctrl driver is not bound, an
+ * appropriate error code otherwise.
+ */
+int pci_pwrctrl_power_on_devices(struct device *parent)
+{
+       struct device_node *np = parent->of_node;
+       struct device_node *child = NULL;
+       int ret;
+
+       for_each_available_child_of_node(np, child) {
+               ret = pci_pwrctrl_power_on_device(child);
+               if (ret)
+                       goto err_power_off;
+       }
+
+       return 0;
+
+err_power_off:
+       for_each_available_child_of_node_scoped(np, tmp) {
+               if (tmp == child)
+                       break;
+               pci_pwrctrl_power_off_device(tmp);
+       }
+       of_node_put(child);
+
+       return ret;
+}
+EXPORT_SYMBOL_GPL(pci_pwrctrl_power_on_devices);
+
 static int pci_pwrctrl_create_device(struct device_node *np,
                                     struct device *parent)
 {

diff --git a/include/linux/pci-pwrctrl.h b/include/linux/pci-pwrctrl.h
index 44f66872d09019b0fcbd489ba85187332a240fb8..1192a2527521d1db8a116f532f70017a0336ba1f 100644 (file)
--- a/include/linux/pci-pwrctrl.h
+++ b/include/linux/pci-pwrctrl.h
@@ -57,8 +57,12 @@ int devm_pci_pwrctrl_device_set_ready(struct device *dev,
 #if IS_ENABLED(CONFIG_PCI_PWRCTRL)
 int pci_pwrctrl_create_devices(struct device *parent);
 void pci_pwrctrl_destroy_devices(struct device *parent);
+int pci_pwrctrl_power_on_devices(struct device *parent);
+void pci_pwrctrl_power_off_devices(struct device *parent);
 #else
 static inline int pci_pwrctrl_create_devices(struct device *parent) { return 0; }
 static void pci_pwrctrl_destroy_devices(struct device *parent) { }
+static inline int pci_pwrctrl_power_on_devices(struct device *parent) { return 0; }
+static void pci_pwrctrl_power_off_devices(struct device *parent) { }
 #endif
 #endif /* __PCI_PWRCTRL_H__ */