|
|
|
@@ -90,29 +90,49 @@ enum pm_qos_flags_status dev_pm_qos_flags(struct device *dev, s32 mask)
|
|
|
|
|
EXPORT_SYMBOL_GPL(dev_pm_qos_flags);
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* __dev_pm_qos_read_value - Get PM QoS constraint for a given device.
|
|
|
|
|
* __dev_pm_qos_resume_latency - Get resume latency constraint for a given device.
|
|
|
|
|
* @dev: Device to get the PM QoS constraint value for.
|
|
|
|
|
*
|
|
|
|
|
* This routine must be called with dev->power.lock held.
|
|
|
|
|
*/
|
|
|
|
|
s32 __dev_pm_qos_read_value(struct device *dev)
|
|
|
|
|
s32 __dev_pm_qos_resume_latency(struct device *dev)
|
|
|
|
|
{
|
|
|
|
|
lockdep_assert_held(&dev->power.lock);
|
|
|
|
|
|
|
|
|
|
return dev_pm_qos_raw_read_value(dev);
|
|
|
|
|
return dev_pm_qos_raw_resume_latency(dev);
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
/**
|
|
|
|
|
* dev_pm_qos_read_value - Get PM QoS constraint for a given device (locked).
|
|
|
|
|
* @dev: Device to get the PM QoS constraint value for.
|
|
|
|
|
* @type: QoS request type.
|
|
|
|
|
*/
|
|
|
|
|
s32 dev_pm_qos_read_value(struct device *dev)
|
|
|
|
|
s32 dev_pm_qos_read_value(struct device *dev, enum dev_pm_qos_req_type type)
|
|
|
|
|
{
|
|
|
|
|
struct dev_pm_qos *qos = dev->power.qos;
|
|
|
|
|
unsigned long flags;
|
|
|
|
|
s32 ret;
|
|
|
|
|
|
|
|
|
|
spin_lock_irqsave(&dev->power.lock, flags);
|
|
|
|
|
ret = __dev_pm_qos_read_value(dev);
|
|
|
|
|
|
|
|
|
|
switch (type) {
|
|
|
|
|
case DEV_PM_QOS_RESUME_LATENCY:
|
|
|
|
|
ret = IS_ERR_OR_NULL(qos) ? PM_QOS_RESUME_LATENCY_NO_CONSTRAINT
|
|
|
|
|
: pm_qos_read_value(&qos->resume_latency);
|
|
|
|
|
break;
|
|
|
|
|
case DEV_PM_QOS_MIN_FREQUENCY:
|
|
|
|
|
ret = IS_ERR_OR_NULL(qos) ? PM_QOS_MIN_FREQUENCY_DEFAULT_VALUE
|
|
|
|
|
: pm_qos_read_value(&qos->min_frequency);
|
|
|
|
|
break;
|
|
|
|
|
case DEV_PM_QOS_MAX_FREQUENCY:
|
|
|
|
|
ret = IS_ERR_OR_NULL(qos) ? PM_QOS_MAX_FREQUENCY_DEFAULT_VALUE
|
|
|
|
|
: pm_qos_read_value(&qos->max_frequency);
|
|
|
|
|
break;
|
|
|
|
|
default:
|
|
|
|
|
WARN_ON(1);
|
|
|
|
|
ret = 0;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
spin_unlock_irqrestore(&dev->power.lock, flags);
|
|
|
|
|
|
|
|
|
|
return ret;
|
|
|
|
@@ -149,6 +169,14 @@ static int apply_constraint(struct dev_pm_qos_request *req,
|
|
|
|
|
req->dev->power.set_latency_tolerance(req->dev, value);
|
|
|
|
|
}
|
|
|
|
|
break;
|
|
|
|
|
case DEV_PM_QOS_MIN_FREQUENCY:
|
|
|
|
|
ret = pm_qos_update_target(&qos->min_frequency,
|
|
|
|
|
&req->data.pnode, action, value);
|
|
|
|
|
break;
|
|
|
|
|
case DEV_PM_QOS_MAX_FREQUENCY:
|
|
|
|
|
ret = pm_qos_update_target(&qos->max_frequency,
|
|
|
|
|
&req->data.pnode, action, value);
|
|
|
|
|
break;
|
|
|
|
|
case DEV_PM_QOS_FLAGS:
|
|
|
|
|
ret = pm_qos_update_flags(&qos->flags, &req->data.flr,
|
|
|
|
|
action, value);
|
|
|
|
@@ -177,12 +205,11 @@ static int dev_pm_qos_constraints_allocate(struct device *dev)
|
|
|
|
|
if (!qos)
|
|
|
|
|
return -ENOMEM;
|
|
|
|
|
|
|
|
|
|
n = kzalloc(sizeof(*n), GFP_KERNEL);
|
|
|
|
|
n = kzalloc(3 * sizeof(*n), GFP_KERNEL);
|
|
|
|
|
if (!n) {
|
|
|
|
|
kfree(qos);
|
|
|
|
|
return -ENOMEM;
|
|
|
|
|
}
|
|
|
|
|
BLOCKING_INIT_NOTIFIER_HEAD(n);
|
|
|
|
|
|
|
|
|
|
c = &qos->resume_latency;
|
|
|
|
|
plist_head_init(&c->list);
|
|
|
|
@@ -191,6 +218,7 @@ static int dev_pm_qos_constraints_allocate(struct device *dev)
|
|
|
|
|
c->no_constraint_value = PM_QOS_RESUME_LATENCY_NO_CONSTRAINT;
|
|
|
|
|
c->type = PM_QOS_MIN;
|
|
|
|
|
c->notifiers = n;
|
|
|
|
|
BLOCKING_INIT_NOTIFIER_HEAD(n);
|
|
|
|
|
|
|
|
|
|
c = &qos->latency_tolerance;
|
|
|
|
|
plist_head_init(&c->list);
|
|
|
|
@@ -199,6 +227,24 @@ static int dev_pm_qos_constraints_allocate(struct device *dev)
|
|
|
|
|
c->no_constraint_value = PM_QOS_LATENCY_TOLERANCE_NO_CONSTRAINT;
|
|
|
|
|
c->type = PM_QOS_MIN;
|
|
|
|
|
|
|
|
|
|
c = &qos->min_frequency;
|
|
|
|
|
plist_head_init(&c->list);
|
|
|
|
|
c->target_value = PM_QOS_MIN_FREQUENCY_DEFAULT_VALUE;
|
|
|
|
|
c->default_value = PM_QOS_MIN_FREQUENCY_DEFAULT_VALUE;
|
|
|
|
|
c->no_constraint_value = PM_QOS_MIN_FREQUENCY_DEFAULT_VALUE;
|
|
|
|
|
c->type = PM_QOS_MAX;
|
|
|
|
|
c->notifiers = ++n;
|
|
|
|
|
BLOCKING_INIT_NOTIFIER_HEAD(n);
|
|
|
|
|
|
|
|
|
|
c = &qos->max_frequency;
|
|
|
|
|
plist_head_init(&c->list);
|
|
|
|
|
c->target_value = PM_QOS_MAX_FREQUENCY_DEFAULT_VALUE;
|
|
|
|
|
c->default_value = PM_QOS_MAX_FREQUENCY_DEFAULT_VALUE;
|
|
|
|
|
c->no_constraint_value = PM_QOS_MAX_FREQUENCY_DEFAULT_VALUE;
|
|
|
|
|
c->type = PM_QOS_MIN;
|
|
|
|
|
c->notifiers = ++n;
|
|
|
|
|
BLOCKING_INIT_NOTIFIER_HEAD(n);
|
|
|
|
|
|
|
|
|
|
INIT_LIST_HEAD(&qos->flags.list);
|
|
|
|
|
|
|
|
|
|
spin_lock_irq(&dev->power.lock);
|
|
|
|
@@ -252,11 +298,25 @@ void dev_pm_qos_constraints_destroy(struct device *dev)
|
|
|
|
|
apply_constraint(req, PM_QOS_REMOVE_REQ, PM_QOS_DEFAULT_VALUE);
|
|
|
|
|
memset(req, 0, sizeof(*req));
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
c = &qos->latency_tolerance;
|
|
|
|
|
plist_for_each_entry_safe(req, tmp, &c->list, data.pnode) {
|
|
|
|
|
apply_constraint(req, PM_QOS_REMOVE_REQ, PM_QOS_DEFAULT_VALUE);
|
|
|
|
|
memset(req, 0, sizeof(*req));
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
c = &qos->min_frequency;
|
|
|
|
|
plist_for_each_entry_safe(req, tmp, &c->list, data.pnode) {
|
|
|
|
|
apply_constraint(req, PM_QOS_REMOVE_REQ, PM_QOS_MIN_FREQUENCY_DEFAULT_VALUE);
|
|
|
|
|
memset(req, 0, sizeof(*req));
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
c = &qos->max_frequency;
|
|
|
|
|
plist_for_each_entry_safe(req, tmp, &c->list, data.pnode) {
|
|
|
|
|
apply_constraint(req, PM_QOS_REMOVE_REQ, PM_QOS_MAX_FREQUENCY_DEFAULT_VALUE);
|
|
|
|
|
memset(req, 0, sizeof(*req));
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
f = &qos->flags;
|
|
|
|
|
list_for_each_entry_safe(req, tmp, &f->list, data.flr.node) {
|
|
|
|
|
apply_constraint(req, PM_QOS_REMOVE_REQ, PM_QOS_DEFAULT_VALUE);
|
|
|
|
@@ -368,6 +428,8 @@ static int __dev_pm_qos_update_request(struct dev_pm_qos_request *req,
|
|
|
|
|
switch(req->type) {
|
|
|
|
|
case DEV_PM_QOS_RESUME_LATENCY:
|
|
|
|
|
case DEV_PM_QOS_LATENCY_TOLERANCE:
|
|
|
|
|
case DEV_PM_QOS_MIN_FREQUENCY:
|
|
|
|
|
case DEV_PM_QOS_MAX_FREQUENCY:
|
|
|
|
|
curr_value = req->data.pnode.prio;
|
|
|
|
|
break;
|
|
|
|
|
case DEV_PM_QOS_FLAGS:
|
|
|
|
@@ -467,6 +529,7 @@ EXPORT_SYMBOL_GPL(dev_pm_qos_remove_request);
|
|
|
|
|
*
|
|
|
|
|
* @dev: target device for the constraint
|
|
|
|
|
* @notifier: notifier block managed by caller.
|
|
|
|
|
* @type: request type.
|
|
|
|
|
*
|
|
|
|
|
* Will register the notifier into a notification chain that gets called
|
|
|
|
|
* upon changes to the target value for the device.
|
|
|
|
@@ -474,7 +537,8 @@ EXPORT_SYMBOL_GPL(dev_pm_qos_remove_request);
|
|
|
|
|
* If the device's constraints object doesn't exist when this routine is called,
|
|
|
|
|
* it will be created (or error code will be returned if that fails).
|
|
|
|
|
*/
|
|
|
|
|
int dev_pm_qos_add_notifier(struct device *dev, struct notifier_block *notifier)
|
|
|
|
|
int dev_pm_qos_add_notifier(struct device *dev, struct notifier_block *notifier,
|
|
|
|
|
enum dev_pm_qos_req_type type)
|
|
|
|
|
{
|
|
|
|
|
int ret = 0;
|
|
|
|
|
|
|
|
|
@@ -485,10 +549,28 @@ int dev_pm_qos_add_notifier(struct device *dev, struct notifier_block *notifier)
|
|
|
|
|
else if (!dev->power.qos)
|
|
|
|
|
ret = dev_pm_qos_constraints_allocate(dev);
|
|
|
|
|
|
|
|
|
|
if (!ret)
|
|
|
|
|
if (ret)
|
|
|
|
|
goto unlock;
|
|
|
|
|
|
|
|
|
|
switch (type) {
|
|
|
|
|
case DEV_PM_QOS_RESUME_LATENCY:
|
|
|
|
|
ret = blocking_notifier_chain_register(dev->power.qos->resume_latency.notifiers,
|
|
|
|
|
notifier);
|
|
|
|
|
break;
|
|
|
|
|
case DEV_PM_QOS_MIN_FREQUENCY:
|
|
|
|
|
ret = blocking_notifier_chain_register(dev->power.qos->min_frequency.notifiers,
|
|
|
|
|
notifier);
|
|
|
|
|
break;
|
|
|
|
|
case DEV_PM_QOS_MAX_FREQUENCY:
|
|
|
|
|
ret = blocking_notifier_chain_register(dev->power.qos->max_frequency.notifiers,
|
|
|
|
|
notifier);
|
|
|
|
|
break;
|
|
|
|
|
default:
|
|
|
|
|
WARN_ON(1);
|
|
|
|
|
ret = -EINVAL;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
unlock:
|
|
|
|
|
mutex_unlock(&dev_pm_qos_mtx);
|
|
|
|
|
return ret;
|
|
|
|
|
}
|
|
|
|
@@ -500,24 +582,44 @@ EXPORT_SYMBOL_GPL(dev_pm_qos_add_notifier);
|
|
|
|
|
*
|
|
|
|
|
* @dev: target device for the constraint
|
|
|
|
|
* @notifier: notifier block to be removed.
|
|
|
|
|
* @type: request type.
|
|
|
|
|
*
|
|
|
|
|
* Will remove the notifier from the notification chain that gets called
|
|
|
|
|
* upon changes to the target value.
|
|
|
|
|
*/
|
|
|
|
|
int dev_pm_qos_remove_notifier(struct device *dev,
|
|
|
|
|
struct notifier_block *notifier)
|
|
|
|
|
struct notifier_block *notifier,
|
|
|
|
|
enum dev_pm_qos_req_type type)
|
|
|
|
|
{
|
|
|
|
|
int retval = 0;
|
|
|
|
|
int ret = 0;
|
|
|
|
|
|
|
|
|
|
mutex_lock(&dev_pm_qos_mtx);
|
|
|
|
|
|
|
|
|
|
/* Silently return if the constraints object is not present. */
|
|
|
|
|
if (!IS_ERR_OR_NULL(dev->power.qos))
|
|
|
|
|
retval = blocking_notifier_chain_unregister(dev->power.qos->resume_latency.notifiers,
|
|
|
|
|
notifier);
|
|
|
|
|
if (IS_ERR_OR_NULL(dev->power.qos))
|
|
|
|
|
goto unlock;
|
|
|
|
|
|
|
|
|
|
switch (type) {
|
|
|
|
|
case DEV_PM_QOS_RESUME_LATENCY:
|
|
|
|
|
ret = blocking_notifier_chain_unregister(dev->power.qos->resume_latency.notifiers,
|
|
|
|
|
notifier);
|
|
|
|
|
break;
|
|
|
|
|
case DEV_PM_QOS_MIN_FREQUENCY:
|
|
|
|
|
ret = blocking_notifier_chain_unregister(dev->power.qos->min_frequency.notifiers,
|
|
|
|
|
notifier);
|
|
|
|
|
break;
|
|
|
|
|
case DEV_PM_QOS_MAX_FREQUENCY:
|
|
|
|
|
ret = blocking_notifier_chain_unregister(dev->power.qos->max_frequency.notifiers,
|
|
|
|
|
notifier);
|
|
|
|
|
break;
|
|
|
|
|
default:
|
|
|
|
|
WARN_ON(1);
|
|
|
|
|
ret = -EINVAL;
|
|
|
|
|
}
|
|
|
|
|
|
|
|
|
|
unlock:
|
|
|
|
|
mutex_unlock(&dev_pm_qos_mtx);
|
|
|
|
|
return retval;
|
|
|
|
|
return ret;
|
|
|
|
|
}
|
|
|
|
|
EXPORT_SYMBOL_GPL(dev_pm_qos_remove_notifier);
|
|
|
|
|
|
|
|
|
@@ -577,6 +679,9 @@ static void __dev_pm_qos_drop_user_request(struct device *dev,
|
|
|
|
|
req = dev->power.qos->flags_req;
|
|
|
|
|
dev->power.qos->flags_req = NULL;
|
|
|
|
|
break;
|
|
|
|
|
default:
|
|
|
|
|
WARN_ON(1);
|
|
|
|
|
return;
|
|
|
|
|
}
|
|
|
|
|
__dev_pm_qos_remove_request(req);
|
|
|
|
|
kfree(req);
|
|
|
|
|