Commit 62d44902 authored by Rafael J. Wysocki's avatar Rafael J. Wysocki

PM / Domains: Allow device callbacks to be added at any time

Make it possible to modify device callbacks used by the generic PM
domains core code at any time, not only after the device has been
added to a domain.  This will allow device drivers to provide their
own device PM domain callbacks even if they are registered before
adding the devices to PM domains.

For this purpose, use the observation that the struct
generic_pm_domain_data object containing the relevant callback
pointers may be allocated by pm_genpd_add_callbacks() and the
callbacks may be set before __pm_genpd_add_device() is run for
the given device.  This object will then be used by
__pm_genpd_add_device(), but it has to be protected from
premature removal by reference counting.
Signed-off-by: default avatarRafael J. Wysocki <rjw@sisk.pl>
parent 1d5fcfec
...@@ -1603,33 +1603,52 @@ int pm_genpd_remove_subdomain(struct generic_pm_domain *genpd, ...@@ -1603,33 +1603,52 @@ int pm_genpd_remove_subdomain(struct generic_pm_domain *genpd,
* @dev: Device to add the callbacks to. * @dev: Device to add the callbacks to.
* @ops: Set of callbacks to add. * @ops: Set of callbacks to add.
* @td: Timing data to add to the device along with the callbacks (optional). * @td: Timing data to add to the device along with the callbacks (optional).
*
* Every call to this routine should be balanced with a call to
* __pm_genpd_remove_callbacks() and they must not be nested.
*/ */
int pm_genpd_add_callbacks(struct device *dev, struct gpd_dev_ops *ops, int pm_genpd_add_callbacks(struct device *dev, struct gpd_dev_ops *ops,
struct gpd_timing_data *td) struct gpd_timing_data *td)
{ {
struct pm_domain_data *pdd; struct generic_pm_domain_data *gpd_data_new, *gpd_data = NULL;
int ret = 0; int ret = 0;
if (!(dev && dev->power.subsys_data && ops)) if (!(dev && ops))
return -EINVAL; return -EINVAL;
gpd_data_new = __pm_genpd_alloc_dev_data(dev);
if (!gpd_data_new)
return -ENOMEM;
pm_runtime_disable(dev); pm_runtime_disable(dev);
device_pm_lock(); device_pm_lock();
pdd = dev->power.subsys_data->domain_data; ret = dev_pm_get_subsys_data(dev);
if (pdd) { if (ret)
struct generic_pm_domain_data *gpd_data = to_gpd_data(pdd); goto out;
spin_lock_irq(&dev->power.lock);
gpd_data->ops = *ops; if (dev->power.subsys_data->domain_data) {
if (td) gpd_data = to_gpd_data(dev->power.subsys_data->domain_data);
gpd_data->td = *td;
} else { } else {
ret = -EINVAL; gpd_data = gpd_data_new;
dev->power.subsys_data->domain_data = &gpd_data->base;
} }
gpd_data->refcount++;
gpd_data->ops = *ops;
if (td)
gpd_data->td = *td;
spin_unlock_irq(&dev->power.lock);
out:
device_pm_unlock(); device_pm_unlock();
pm_runtime_enable(dev); pm_runtime_enable(dev);
if (gpd_data != gpd_data_new)
__pm_genpd_free_dev_data(dev, gpd_data_new);
return ret; return ret;
} }
EXPORT_SYMBOL_GPL(pm_genpd_add_callbacks); EXPORT_SYMBOL_GPL(pm_genpd_add_callbacks);
...@@ -1638,10 +1657,13 @@ EXPORT_SYMBOL_GPL(pm_genpd_add_callbacks); ...@@ -1638,10 +1657,13 @@ EXPORT_SYMBOL_GPL(pm_genpd_add_callbacks);
* __pm_genpd_remove_callbacks - Remove PM domain callbacks from a given device. * __pm_genpd_remove_callbacks - Remove PM domain callbacks from a given device.
* @dev: Device to remove the callbacks from. * @dev: Device to remove the callbacks from.
* @clear_td: If set, clear the device's timing data too. * @clear_td: If set, clear the device's timing data too.
*
* This routine can only be called after pm_genpd_add_callbacks().
*/ */
int __pm_genpd_remove_callbacks(struct device *dev, bool clear_td) int __pm_genpd_remove_callbacks(struct device *dev, bool clear_td)
{ {
struct pm_domain_data *pdd; struct generic_pm_domain_data *gpd_data = NULL;
bool remove = false;
int ret = 0; int ret = 0;
if (!(dev && dev->power.subsys_data)) if (!(dev && dev->power.subsys_data))
...@@ -1650,21 +1672,35 @@ int __pm_genpd_remove_callbacks(struct device *dev, bool clear_td) ...@@ -1650,21 +1672,35 @@ int __pm_genpd_remove_callbacks(struct device *dev, bool clear_td)
pm_runtime_disable(dev); pm_runtime_disable(dev);
device_pm_lock(); device_pm_lock();
pdd = dev->power.subsys_data->domain_data; spin_lock_irq(&dev->power.lock);
if (pdd) {
struct generic_pm_domain_data *gpd_data = to_gpd_data(pdd);
if (dev->power.subsys_data->domain_data) {
gpd_data = to_gpd_data(dev->power.subsys_data->domain_data);
gpd_data->ops = (struct gpd_dev_ops){ 0 }; gpd_data->ops = (struct gpd_dev_ops){ 0 };
if (clear_td) if (clear_td)
gpd_data->td = (struct gpd_timing_data){ 0 }; gpd_data->td = (struct gpd_timing_data){ 0 };
if (--gpd_data->refcount == 0) {
dev->power.subsys_data->domain_data = NULL;
remove = true;
}
} else { } else {
ret = -EINVAL; ret = -EINVAL;
} }
spin_unlock_irq(&dev->power.lock);
device_pm_unlock(); device_pm_unlock();
pm_runtime_enable(dev); pm_runtime_enable(dev);
return ret; if (ret)
return ret;
dev_pm_put_subsys_data(dev);
if (remove)
__pm_genpd_free_dev_data(dev, gpd_data);
return 0;
} }
EXPORT_SYMBOL_GPL(__pm_genpd_remove_callbacks); EXPORT_SYMBOL_GPL(__pm_genpd_remove_callbacks);
......
Markdown is supported
0%
or
You are about to add 0 people to the discussion. Proceed with caution.
Finish editing this message first!
Please register or to comment