// SPDX-License-Identifier: GPL-2.0-only /* * Copyright (C) 2024 Linaro Ltd. */ #include #include #include #include #include #include #include static int pci_pwrctl_notify(struct notifier_block *nb, unsigned long action, void *data) { struct pci_pwrctl *pwrctl = container_of(nb, struct pci_pwrctl, nb); struct device *dev = data; if (dev_fwnode(dev) != dev_fwnode(pwrctl->dev)) return NOTIFY_DONE; switch (action) { case BUS_NOTIFY_ADD_DEVICE: /* * We will have two struct device objects bound to two different * drivers on different buses but consuming the same DT node. We * must not bind the pins twice in this case but only once for * the first device to be added. * * If we got here then the PCI device is the second after the * power control platform device. Mark its OF node as reused. */ dev->of_node_reused = true; break; case BUS_NOTIFY_BOUND_DRIVER: pwrctl->link = device_link_add(dev, pwrctl->dev, DL_FLAG_AUTOREMOVE_CONSUMER); if (!pwrctl->link) dev_err(pwrctl->dev, "Failed to add device link\n"); break; case BUS_NOTIFY_UNBOUND_DRIVER: if (pwrctl->link) device_link_remove(dev, pwrctl->dev); break; } return NOTIFY_DONE; } static void rescan_work_func(struct work_struct *work) { struct pci_pwrctl *pwrctl = container_of(work, struct pci_pwrctl, work); pci_lock_rescan_remove(); pci_rescan_bus(to_pci_dev(pwrctl->dev->parent)->bus); pci_unlock_rescan_remove(); } /** * pci_pwrctl_init() - Initialize the PCI power control context struct * * @pwrctl: PCI power control data * @dev: Parent device */ void pci_pwrctl_init(struct pci_pwrctl *pwrctl, struct device *dev) { pwrctl->dev = dev; INIT_WORK(&pwrctl->work, rescan_work_func); } EXPORT_SYMBOL_GPL(pci_pwrctl_init); /** * pci_pwrctl_device_set_ready() - Notify the pwrctl subsystem that the PCI * device is powered-up and ready to be detected. * * @pwrctl: PCI power control data. * * Returns: * 0 on success, negative error number on error. * * Note: * This function returning 0 doesn't mean the device was detected. It means, * that the bus rescan was successfully started. The device will get bound to * its PCI driver asynchronously. */ int pci_pwrctl_device_set_ready(struct pci_pwrctl *pwrctl) { int ret; if (!pwrctl->dev) return -ENODEV; pwrctl->nb.notifier_call = pci_pwrctl_notify; ret = bus_register_notifier(&pci_bus_type, &pwrctl->nb); if (ret) return ret; schedule_work(&pwrctl->work); return 0; } EXPORT_SYMBOL_GPL(pci_pwrctl_device_set_ready); /** * pci_pwrctl_device_unset_ready() - Notify the pwrctl subsystem that the PCI * device is about to be powered-down. * * @pwrctl: PCI power control data. */ void pci_pwrctl_device_unset_ready(struct pci_pwrctl *pwrctl) { /* * We don't have to delete the link here. Typically, this function * is only called when the power control device is being detached. If * it is being detached then the child PCI device must have already * been unbound too or the device core wouldn't let us unbind. */ bus_unregister_notifier(&pci_bus_type, &pwrctl->nb); } EXPORT_SYMBOL_GPL(pci_pwrctl_device_unset_ready); static void devm_pci_pwrctl_device_unset_ready(void *data) { struct pci_pwrctl *pwrctl = data; pci_pwrctl_device_unset_ready(pwrctl); } /** * devm_pci_pwrctl_device_set_ready - Managed variant of * pci_pwrctl_device_set_ready(). * * @dev: Device managing this pwrctl provider. * @pwrctl: PCI power control data. * * Returns: * 0 on success, negative error number on error. */ int devm_pci_pwrctl_device_set_ready(struct device *dev, struct pci_pwrctl *pwrctl) { int ret; ret = pci_pwrctl_device_set_ready(pwrctl); if (ret) return ret; return devm_add_action_or_reset(dev, devm_pci_pwrctl_device_unset_ready, pwrctl); } EXPORT_SYMBOL_GPL(devm_pci_pwrctl_device_set_ready); MODULE_AUTHOR("Bartosz Golaszewski "); MODULE_DESCRIPTION("PCI Device Power Control core driver"); MODULE_LICENSE("GPL");