1 // SPDX-License-Identifier: GPL-2.0-only
2 /*
3 * Power Management Quality of Service (PM QoS) support base.
4 *
5 * Copyright (C) 2020 Intel Corporation
6 *
7 * Authors:
8 * Mark Gross <mgross@linux.intel.com>
9 * Rafael J. Wysocki <rafael.j.wysocki@intel.com>
10 *
11 * Provided here is an interface for specifying PM QoS dependencies. It allows
12 * entities depending on QoS constraints to register their requests which are
13 * aggregated as appropriate to produce effective constraints (target values)
14 * that can be monitored by entities needing to respect them, either by polling
15 * or through a built-in notification mechanism.
16 *
17 * In addition to the basic functionality, more specific interfaces for managing
18 * global CPU latency QoS requests and frequency QoS requests are provided.
19 */
20
21 /*#define DEBUG*/
22
23 #include <linux/pm_qos.h>
24 #include <linux/sched.h>
25 #include <linux/spinlock.h>
26 #include <linux/slab.h>
27 #include <linux/time.h>
28 #include <linux/fs.h>
29 #include <linux/device.h>
30 #include <linux/miscdevice.h>
31 #include <linux/string.h>
32 #include <linux/platform_device.h>
33 #include <linux/init.h>
34 #include <linux/kernel.h>
35 #include <linux/debugfs.h>
36 #include <linux/seq_file.h>
37
38 #include <linux/uaccess.h>
39 #include <linux/export.h>
40 #include <trace/events/power.h>
41
42 /*
43 * locking rule: all changes to constraints or notifiers lists
44 * or pm_qos_object list and pm_qos_objects need to happen with pm_qos_lock
45 * held, taken with _irqsave. One lock to rule them all
46 */
47 static DEFINE_SPINLOCK(pm_qos_lock);
48
49 /**
50 * pm_qos_read_value - Return the current effective constraint value.
51 * @c: List of PM QoS constraint requests.
52 */
pm_qos_read_value(struct pm_qos_constraints * c)53 s32 pm_qos_read_value(struct pm_qos_constraints *c)
54 {
55 return READ_ONCE(c->target_value);
56 }
57
pm_qos_get_value(struct pm_qos_constraints * c)58 static int pm_qos_get_value(struct pm_qos_constraints *c)
59 {
60 if (plist_head_empty(&c->list))
61 return c->no_constraint_value;
62
63 switch (c->type) {
64 case PM_QOS_MIN:
65 return plist_first(&c->list)->prio;
66
67 case PM_QOS_MAX:
68 return plist_last(&c->list)->prio;
69
70 default:
71 WARN(1, "Unknown PM QoS type in %s\n", __func__);
72 return PM_QOS_DEFAULT_VALUE;
73 }
74 }
75
pm_qos_set_value(struct pm_qos_constraints * c,s32 value)76 static void pm_qos_set_value(struct pm_qos_constraints *c, s32 value)
77 {
78 WRITE_ONCE(c->target_value, value);
79 }
80
81 /**
82 * pm_qos_update_target - Update a list of PM QoS constraint requests.
83 * @c: List of PM QoS requests.
84 * @node: Target list entry.
85 * @action: Action to carry out (add, update or remove).
86 * @value: New request value for the target list entry.
87 *
88 * Update the given list of PM QoS constraint requests, @c, by carrying an
89 * @action involving the @node list entry and @value on it.
90 *
91 * The recognized values of @action are PM_QOS_ADD_REQ (store @value in @node
92 * and add it to the list), PM_QOS_UPDATE_REQ (remove @node from the list, store
93 * @value in it and add it to the list again), and PM_QOS_REMOVE_REQ (remove
94 * @node from the list, ignore @value).
95 *
96 * Return: 1 if the aggregate constraint value has changed, 0 otherwise.
97 */
pm_qos_update_target(struct pm_qos_constraints * c,struct plist_node * node,enum pm_qos_req_action action,int value)98 int pm_qos_update_target(struct pm_qos_constraints *c, struct plist_node *node,
99 enum pm_qos_req_action action, int value)
100 {
101 int prev_value, curr_value, new_value;
102 unsigned long flags;
103
104 spin_lock_irqsave(&pm_qos_lock, flags);
105
106 prev_value = pm_qos_get_value(c);
107 if (value == PM_QOS_DEFAULT_VALUE)
108 new_value = c->default_value;
109 else
110 new_value = value;
111
112 switch (action) {
113 case PM_QOS_REMOVE_REQ:
114 plist_del(node, &c->list);
115 break;
116 case PM_QOS_UPDATE_REQ:
117 /*
118 * To change the list, atomically remove, reinit with new value
119 * and add, then see if the aggregate has changed.
120 */
121 plist_del(node, &c->list);
122 fallthrough;
123 case PM_QOS_ADD_REQ:
124 plist_node_init(node, new_value);
125 plist_add(node, &c->list);
126 break;
127 default:
128 /* no action */
129 ;
130 }
131
132 curr_value = pm_qos_get_value(c);
133 pm_qos_set_value(c, curr_value);
134
135 spin_unlock_irqrestore(&pm_qos_lock, flags);
136
137 trace_pm_qos_update_target(action, prev_value, curr_value);
138
139 if (prev_value == curr_value)
140 return 0;
141
142 if (c->notifiers)
143 blocking_notifier_call_chain(c->notifiers, curr_value, NULL);
144
145 return 1;
146 }
147
148 /**
149 * pm_qos_flags_remove_req - Remove device PM QoS flags request.
150 * @pqf: Device PM QoS flags set to remove the request from.
151 * @req: Request to remove from the set.
152 */
pm_qos_flags_remove_req(struct pm_qos_flags * pqf,struct pm_qos_flags_request * req)153 static void pm_qos_flags_remove_req(struct pm_qos_flags *pqf,
154 struct pm_qos_flags_request *req)
155 {
156 s32 val = 0;
157
158 list_del(&req->node);
159 list_for_each_entry(req, &pqf->list, node)
160 val |= req->flags;
161
162 pqf->effective_flags = val;
163 }
164
165 /**
166 * pm_qos_update_flags - Update a set of PM QoS flags.
167 * @pqf: Set of PM QoS flags to update.
168 * @req: Request to add to the set, to modify, or to remove from the set.
169 * @action: Action to take on the set.
170 * @val: Value of the request to add or modify.
171 *
172 * Return: 1 if the aggregate constraint value has changed, 0 otherwise.
173 */
pm_qos_update_flags(struct pm_qos_flags * pqf,struct pm_qos_flags_request * req,enum pm_qos_req_action action,s32 val)174 bool pm_qos_update_flags(struct pm_qos_flags *pqf,
175 struct pm_qos_flags_request *req,
176 enum pm_qos_req_action action, s32 val)
177 {
178 unsigned long irqflags;
179 s32 prev_value, curr_value;
180
181 spin_lock_irqsave(&pm_qos_lock, irqflags);
182
183 prev_value = list_empty(&pqf->list) ? 0 : pqf->effective_flags;
184
185 switch (action) {
186 case PM_QOS_REMOVE_REQ:
187 pm_qos_flags_remove_req(pqf, req);
188 break;
189 case PM_QOS_UPDATE_REQ:
190 pm_qos_flags_remove_req(pqf, req);
191 fallthrough;
192 case PM_QOS_ADD_REQ:
193 req->flags = val;
194 INIT_LIST_HEAD(&req->node);
195 list_add_tail(&req->node, &pqf->list);
196 pqf->effective_flags |= val;
197 break;
198 default:
199 /* no action */
200 ;
201 }
202
203 curr_value = list_empty(&pqf->list) ? 0 : pqf->effective_flags;
204
205 spin_unlock_irqrestore(&pm_qos_lock, irqflags);
206
207 trace_pm_qos_update_flags(action, prev_value, curr_value);
208
209 return prev_value != curr_value;
210 }
211
212 #ifdef CONFIG_CPU_IDLE
213 /* Definitions related to the CPU latency QoS. */
214
215 static struct pm_qos_constraints cpu_latency_constraints = {
216 .list = PLIST_HEAD_INIT(cpu_latency_constraints.list),
217 .target_value = PM_QOS_CPU_LATENCY_DEFAULT_VALUE,
218 .default_value = PM_QOS_CPU_LATENCY_DEFAULT_VALUE,
219 .no_constraint_value = PM_QOS_CPU_LATENCY_DEFAULT_VALUE,
220 .type = PM_QOS_MIN,
221 };
222
cpu_latency_qos_value_invalid(s32 value)223 static inline bool cpu_latency_qos_value_invalid(s32 value)
224 {
225 return value < 0 && value != PM_QOS_DEFAULT_VALUE;
226 }
227
228 /**
229 * cpu_latency_qos_limit - Return current system-wide CPU latency QoS limit.
230 */
cpu_latency_qos_limit(void)231 s32 cpu_latency_qos_limit(void)
232 {
233 return pm_qos_read_value(&cpu_latency_constraints);
234 }
235
236 /**
237 * cpu_latency_qos_request_active - Check the given PM QoS request.
238 * @req: PM QoS request to check.
239 *
240 * Return: 'true' if @req has been added to the CPU latency QoS list, 'false'
241 * otherwise.
242 */
cpu_latency_qos_request_active(struct pm_qos_request * req)243 bool cpu_latency_qos_request_active(struct pm_qos_request *req)
244 {
245 return req->qos == &cpu_latency_constraints;
246 }
247 EXPORT_SYMBOL_GPL(cpu_latency_qos_request_active);
248
cpu_latency_qos_apply(struct pm_qos_request * req,enum pm_qos_req_action action,s32 value)249 static void cpu_latency_qos_apply(struct pm_qos_request *req,
250 enum pm_qos_req_action action, s32 value)
251 {
252 int ret = pm_qos_update_target(req->qos, &req->node, action, value);
253 if (ret > 0)
254 wake_up_all_idle_cpus();
255 }
256
257 /**
258 * cpu_latency_qos_add_request - Add new CPU latency QoS request.
259 * @req: Pointer to a preallocated handle.
260 * @value: Requested constraint value.
261 *
262 * Use @value to initialize the request handle pointed to by @req, insert it as
263 * a new entry to the CPU latency QoS list and recompute the effective QoS
264 * constraint for that list.
265 *
266 * Callers need to save the handle for later use in updates and removal of the
267 * QoS request represented by it.
268 */
cpu_latency_qos_add_request(struct pm_qos_request * req,s32 value)269 void cpu_latency_qos_add_request(struct pm_qos_request *req, s32 value)
270 {
271 if (!req || cpu_latency_qos_value_invalid(value))
272 return;
273
274 if (cpu_latency_qos_request_active(req)) {
275 WARN(1, KERN_ERR "%s called for already added request\n", __func__);
276 return;
277 }
278
279 trace_pm_qos_add_request(value);
280
281 req->qos = &cpu_latency_constraints;
282 cpu_latency_qos_apply(req, PM_QOS_ADD_REQ, value);
283 }
284 EXPORT_SYMBOL_GPL(cpu_latency_qos_add_request);
285
286 /**
287 * cpu_latency_qos_update_request - Modify existing CPU latency QoS request.
288 * @req : QoS request to update.
289 * @new_value: New requested constraint value.
290 *
291 * Use @new_value to update the QoS request represented by @req in the CPU
292 * latency QoS list along with updating the effective constraint value for that
293 * list.
294 */
cpu_latency_qos_update_request(struct pm_qos_request * req,s32 new_value)295 void cpu_latency_qos_update_request(struct pm_qos_request *req, s32 new_value)
296 {
297 if (!req || cpu_latency_qos_value_invalid(new_value))
298 return;
299
300 if (!cpu_latency_qos_request_active(req)) {
301 WARN(1, KERN_ERR "%s called for unknown object\n", __func__);
302 return;
303 }
304
305 trace_pm_qos_update_request(new_value);
306
307 if (new_value == req->node.prio)
308 return;
309
310 cpu_latency_qos_apply(req, PM_QOS_UPDATE_REQ, new_value);
311 }
312 EXPORT_SYMBOL_GPL(cpu_latency_qos_update_request);
313
314 /**
315 * cpu_latency_qos_remove_request - Remove existing CPU latency QoS request.
316 * @req: QoS request to remove.
317 *
318 * Remove the CPU latency QoS request represented by @req from the CPU latency
319 * QoS list along with updating the effective constraint value for that list.
320 */
cpu_latency_qos_remove_request(struct pm_qos_request * req)321 void cpu_latency_qos_remove_request(struct pm_qos_request *req)
322 {
323 if (!req)
324 return;
325
326 if (!cpu_latency_qos_request_active(req)) {
327 WARN(1, KERN_ERR "%s called for unknown object\n", __func__);
328 return;
329 }
330
331 trace_pm_qos_remove_request(PM_QOS_DEFAULT_VALUE);
332
333 cpu_latency_qos_apply(req, PM_QOS_REMOVE_REQ, PM_QOS_DEFAULT_VALUE);
334 memset(req, 0, sizeof(*req));
335 }
336 EXPORT_SYMBOL_GPL(cpu_latency_qos_remove_request);
337
338 /* User space interface to the CPU latency QoS via misc device. */
339
cpu_latency_qos_open(struct inode * inode,struct file * filp)340 static int cpu_latency_qos_open(struct inode *inode, struct file *filp)
341 {
342 struct pm_qos_request *req;
343
344 req = kzalloc_obj(*req);
345 if (!req)
346 return -ENOMEM;
347
348 cpu_latency_qos_add_request(req, PM_QOS_DEFAULT_VALUE);
349 filp->private_data = req;
350
351 return 0;
352 }
353
cpu_latency_qos_release(struct inode * inode,struct file * filp)354 static int cpu_latency_qos_release(struct inode *inode, struct file *filp)
355 {
356 struct pm_qos_request *req = filp->private_data;
357
358 filp->private_data = NULL;
359
360 cpu_latency_qos_remove_request(req);
361 kfree(req);
362
363 return 0;
364 }
365
cpu_latency_qos_read(struct file * filp,char __user * buf,size_t count,loff_t * f_pos)366 static ssize_t cpu_latency_qos_read(struct file *filp, char __user *buf,
367 size_t count, loff_t *f_pos)
368 {
369 struct pm_qos_request *req = filp->private_data;
370 unsigned long flags;
371 s32 value;
372
373 if (!req || !cpu_latency_qos_request_active(req))
374 return -EINVAL;
375
376 spin_lock_irqsave(&pm_qos_lock, flags);
377 value = pm_qos_get_value(&cpu_latency_constraints);
378 spin_unlock_irqrestore(&pm_qos_lock, flags);
379
380 return simple_read_from_buffer(buf, count, f_pos, &value, sizeof(s32));
381 }
382
cpu_latency_qos_write(struct file * filp,const char __user * buf,size_t count,loff_t * f_pos)383 static ssize_t cpu_latency_qos_write(struct file *filp, const char __user *buf,
384 size_t count, loff_t *f_pos)
385 {
386 s32 value;
387
388 if (count == sizeof(s32)) {
389 if (copy_from_user(&value, buf, sizeof(s32)))
390 return -EFAULT;
391 } else {
392 int ret;
393
394 ret = kstrtos32_from_user(buf, count, 16, &value);
395 if (ret)
396 return ret;
397 }
398
399 cpu_latency_qos_update_request(filp->private_data, value);
400
401 return count;
402 }
403
404 static const struct file_operations cpu_latency_qos_fops = {
405 .write = cpu_latency_qos_write,
406 .read = cpu_latency_qos_read,
407 .open = cpu_latency_qos_open,
408 .release = cpu_latency_qos_release,
409 .llseek = noop_llseek,
410 };
411
412 static struct miscdevice cpu_latency_qos_miscdev = {
413 .minor = MISC_DYNAMIC_MINOR,
414 .name = "cpu_dma_latency",
415 .fops = &cpu_latency_qos_fops,
416 };
417
418 #ifdef CONFIG_PM_QOS_CPU_SYSTEM_WAKEUP
419 /* The CPU system wakeup latency QoS. */
420 static struct pm_qos_constraints cpu_wakeup_latency_constraints = {
421 .list = PLIST_HEAD_INIT(cpu_wakeup_latency_constraints.list),
422 .target_value = PM_QOS_RESUME_LATENCY_NO_CONSTRAINT,
423 .default_value = PM_QOS_RESUME_LATENCY_NO_CONSTRAINT,
424 .no_constraint_value = PM_QOS_RESUME_LATENCY_NO_CONSTRAINT,
425 .type = PM_QOS_MIN,
426 };
427
428 /**
429 * cpu_wakeup_latency_qos_limit - Current CPU system wakeup latency QoS limit.
430 *
431 * Returns the current CPU system wakeup latency QoS limit that may have been
432 * requested by user space.
433 */
cpu_wakeup_latency_qos_limit(void)434 s32 cpu_wakeup_latency_qos_limit(void)
435 {
436 return pm_qos_read_value(&cpu_wakeup_latency_constraints);
437 }
438
cpu_wakeup_latency_qos_open(struct inode * inode,struct file * filp)439 static int cpu_wakeup_latency_qos_open(struct inode *inode, struct file *filp)
440 {
441 struct pm_qos_request *req;
442
443 req = kzalloc_obj(*req);
444 if (!req)
445 return -ENOMEM;
446
447 req->qos = &cpu_wakeup_latency_constraints;
448 pm_qos_update_target(req->qos, &req->node, PM_QOS_ADD_REQ,
449 PM_QOS_RESUME_LATENCY_NO_CONSTRAINT);
450 filp->private_data = req;
451
452 return 0;
453 }
454
cpu_wakeup_latency_qos_release(struct inode * inode,struct file * filp)455 static int cpu_wakeup_latency_qos_release(struct inode *inode,
456 struct file *filp)
457 {
458 struct pm_qos_request *req = filp->private_data;
459
460 filp->private_data = NULL;
461 pm_qos_update_target(req->qos, &req->node, PM_QOS_REMOVE_REQ,
462 PM_QOS_RESUME_LATENCY_NO_CONSTRAINT);
463 kfree(req);
464
465 return 0;
466 }
467
cpu_wakeup_latency_qos_read(struct file * filp,char __user * buf,size_t count,loff_t * f_pos)468 static ssize_t cpu_wakeup_latency_qos_read(struct file *filp, char __user *buf,
469 size_t count, loff_t *f_pos)
470 {
471 s32 value = pm_qos_read_value(&cpu_wakeup_latency_constraints);
472
473 return simple_read_from_buffer(buf, count, f_pos, &value, sizeof(s32));
474 }
475
cpu_wakeup_latency_qos_write(struct file * filp,const char __user * buf,size_t count,loff_t * f_pos)476 static ssize_t cpu_wakeup_latency_qos_write(struct file *filp,
477 const char __user *buf,
478 size_t count, loff_t *f_pos)
479 {
480 struct pm_qos_request *req = filp->private_data;
481 s32 value;
482
483 if (count == sizeof(s32)) {
484 if (copy_from_user(&value, buf, sizeof(s32)))
485 return -EFAULT;
486 } else {
487 int ret;
488
489 ret = kstrtos32_from_user(buf, count, 16, &value);
490 if (ret)
491 return ret;
492 }
493
494 if (value < 0)
495 return -EINVAL;
496
497 pm_qos_update_target(req->qos, &req->node, PM_QOS_UPDATE_REQ, value);
498
499 return count;
500 }
501
502 static const struct file_operations cpu_wakeup_latency_qos_fops = {
503 .open = cpu_wakeup_latency_qos_open,
504 .release = cpu_wakeup_latency_qos_release,
505 .read = cpu_wakeup_latency_qos_read,
506 .write = cpu_wakeup_latency_qos_write,
507 .llseek = noop_llseek,
508 };
509
510 static struct miscdevice cpu_wakeup_latency_qos_miscdev = {
511 .minor = MISC_DYNAMIC_MINOR,
512 .name = "cpu_wakeup_latency",
513 .fops = &cpu_wakeup_latency_qos_fops,
514 };
515 #endif /* CONFIG_PM_QOS_CPU_SYSTEM_WAKEUP */
516
cpu_latency_qos_init(void)517 static int __init cpu_latency_qos_init(void)
518 {
519 int ret;
520
521 ret = misc_register(&cpu_latency_qos_miscdev);
522 if (ret < 0)
523 pr_err("%s: %s setup failed\n", __func__,
524 cpu_latency_qos_miscdev.name);
525
526 #ifdef CONFIG_PM_QOS_CPU_SYSTEM_WAKEUP
527 ret = misc_register(&cpu_wakeup_latency_qos_miscdev);
528 if (ret < 0)
529 pr_err("%s: %s setup failed\n", __func__,
530 cpu_wakeup_latency_qos_miscdev.name);
531 #endif
532
533 return ret;
534 }
535 late_initcall(cpu_latency_qos_init);
536 #endif /* CONFIG_CPU_IDLE */
537
538 /* Definitions related to the frequency QoS below. */
539
freq_qos_value_invalid(s32 value)540 static inline bool freq_qos_value_invalid(s32 value)
541 {
542 return value < 0 && value != PM_QOS_DEFAULT_VALUE;
543 }
544
545 /**
546 * freq_constraints_init - Initialize frequency QoS constraints.
547 * @qos: Frequency QoS constraints to initialize.
548 */
freq_constraints_init(struct freq_constraints * qos)549 void freq_constraints_init(struct freq_constraints *qos)
550 {
551 struct pm_qos_constraints *c;
552
553 c = &qos->min_freq;
554 plist_head_init(&c->list);
555 c->target_value = FREQ_QOS_MIN_DEFAULT_VALUE;
556 c->default_value = FREQ_QOS_MIN_DEFAULT_VALUE;
557 c->no_constraint_value = FREQ_QOS_MIN_DEFAULT_VALUE;
558 c->type = PM_QOS_MAX;
559 c->notifiers = &qos->min_freq_notifiers;
560 BLOCKING_INIT_NOTIFIER_HEAD(c->notifiers);
561
562 c = &qos->max_freq;
563 plist_head_init(&c->list);
564 c->target_value = FREQ_QOS_MAX_DEFAULT_VALUE;
565 c->default_value = FREQ_QOS_MAX_DEFAULT_VALUE;
566 c->no_constraint_value = FREQ_QOS_MAX_DEFAULT_VALUE;
567 c->type = PM_QOS_MIN;
568 c->notifiers = &qos->max_freq_notifiers;
569 BLOCKING_INIT_NOTIFIER_HEAD(c->notifiers);
570 }
571
572 /**
573 * freq_qos_read_value - Get frequency QoS constraint for a given list.
574 * @qos: Constraints to evaluate.
575 * @type: QoS request type.
576 */
freq_qos_read_value(struct freq_constraints * qos,enum freq_qos_req_type type)577 s32 freq_qos_read_value(struct freq_constraints *qos,
578 enum freq_qos_req_type type)
579 {
580 s32 ret;
581
582 switch (type) {
583 case FREQ_QOS_MIN:
584 ret = IS_ERR_OR_NULL(qos) ?
585 FREQ_QOS_MIN_DEFAULT_VALUE :
586 pm_qos_read_value(&qos->min_freq);
587 break;
588 case FREQ_QOS_MAX:
589 ret = IS_ERR_OR_NULL(qos) ?
590 FREQ_QOS_MAX_DEFAULT_VALUE :
591 pm_qos_read_value(&qos->max_freq);
592 break;
593 default:
594 WARN_ON(1);
595 ret = 0;
596 }
597
598 return ret;
599 }
600
601 /**
602 * freq_qos_apply - Add/modify/remove frequency QoS request.
603 * @req: Constraint request to apply.
604 * @action: Action to perform (add/update/remove).
605 * @value: Value to assign to the QoS request.
606 *
607 * This is only meant to be called from inside pm_qos, not drivers.
608 */
freq_qos_apply(struct freq_qos_request * req,enum pm_qos_req_action action,s32 value)609 int freq_qos_apply(struct freq_qos_request *req,
610 enum pm_qos_req_action action, s32 value)
611 {
612 int ret;
613
614 switch(req->type) {
615 case FREQ_QOS_MIN:
616 ret = pm_qos_update_target(&req->qos->min_freq, &req->pnode,
617 action, value);
618 break;
619 case FREQ_QOS_MAX:
620 ret = pm_qos_update_target(&req->qos->max_freq, &req->pnode,
621 action, value);
622 break;
623 default:
624 ret = -EINVAL;
625 }
626
627 return ret;
628 }
629
630 /**
631 * freq_qos_add_request - Insert new frequency QoS request into a given list.
632 * @qos: Constraints to update.
633 * @req: Preallocated request object.
634 * @type: Request type.
635 * @value: Request value.
636 *
637 * Insert a new entry into the @qos list of requests, recompute the effective
638 * QoS constraint value for that list and initialize the @req object. The
639 * caller needs to save that object for later use in updates and removal.
640 *
641 * Return 1 if the effective constraint value has changed, 0 if the effective
642 * constraint value has not changed, or a negative error code on failures.
643 */
freq_qos_add_request(struct freq_constraints * qos,struct freq_qos_request * req,enum freq_qos_req_type type,s32 value)644 int freq_qos_add_request(struct freq_constraints *qos,
645 struct freq_qos_request *req,
646 enum freq_qos_req_type type, s32 value)
647 {
648 int ret;
649
650 if (IS_ERR_OR_NULL(qos) || !req || freq_qos_value_invalid(value))
651 return -EINVAL;
652
653 if (WARN(freq_qos_request_active(req),
654 "%s() called for active request\n", __func__))
655 return -EINVAL;
656
657 req->qos = qos;
658 req->type = type;
659 ret = freq_qos_apply(req, PM_QOS_ADD_REQ, value);
660 if (ret < 0) {
661 req->qos = NULL;
662 req->type = 0;
663 }
664
665 return ret;
666 }
667 EXPORT_SYMBOL_GPL(freq_qos_add_request);
668
669 /**
670 * freq_qos_update_request - Modify existing frequency QoS request.
671 * @req: Request to modify.
672 * @new_value: New request value.
673 *
674 * Update an existing frequency QoS request along with the effective constraint
675 * value for the list of requests it belongs to.
676 *
677 * Return 1 if the effective constraint value has changed, 0 if the effective
678 * constraint value has not changed, or a negative error code on failures.
679 */
freq_qos_update_request(struct freq_qos_request * req,s32 new_value)680 int freq_qos_update_request(struct freq_qos_request *req, s32 new_value)
681 {
682 if (!req || freq_qos_value_invalid(new_value))
683 return -EINVAL;
684
685 if (WARN(!freq_qos_request_active(req),
686 "%s() called for unknown object\n", __func__))
687 return -EINVAL;
688
689 if (req->pnode.prio == new_value)
690 return 0;
691
692 return freq_qos_apply(req, PM_QOS_UPDATE_REQ, new_value);
693 }
694 EXPORT_SYMBOL_GPL(freq_qos_update_request);
695
696 /**
697 * freq_qos_remove_request - Remove frequency QoS request from its list.
698 * @req: Request to remove.
699 *
700 * Remove the given frequency QoS request from the list of constraints it
701 * belongs to and recompute the effective constraint value for that list.
702 *
703 * Return 1 if the effective constraint value has changed, 0 if the effective
704 * constraint value has not changed, or a negative error code on failures.
705 */
freq_qos_remove_request(struct freq_qos_request * req)706 int freq_qos_remove_request(struct freq_qos_request *req)
707 {
708 int ret;
709
710 if (!req)
711 return -EINVAL;
712
713 if (WARN(!freq_qos_request_active(req),
714 "%s() called for unknown object\n", __func__))
715 return -EINVAL;
716
717 ret = freq_qos_apply(req, PM_QOS_REMOVE_REQ, PM_QOS_DEFAULT_VALUE);
718 req->qos = NULL;
719 req->type = 0;
720
721 return ret;
722 }
723 EXPORT_SYMBOL_GPL(freq_qos_remove_request);
724
725 /**
726 * freq_qos_add_notifier - Add frequency QoS change notifier.
727 * @qos: List of requests to add the notifier to.
728 * @type: Request type.
729 * @notifier: Notifier block to add.
730 */
freq_qos_add_notifier(struct freq_constraints * qos,enum freq_qos_req_type type,struct notifier_block * notifier)731 int freq_qos_add_notifier(struct freq_constraints *qos,
732 enum freq_qos_req_type type,
733 struct notifier_block *notifier)
734 {
735 int ret;
736
737 if (IS_ERR_OR_NULL(qos) || !notifier)
738 return -EINVAL;
739
740 switch (type) {
741 case FREQ_QOS_MIN:
742 ret = blocking_notifier_chain_register(qos->min_freq.notifiers,
743 notifier);
744 break;
745 case FREQ_QOS_MAX:
746 ret = blocking_notifier_chain_register(qos->max_freq.notifiers,
747 notifier);
748 break;
749 default:
750 WARN_ON(1);
751 ret = -EINVAL;
752 }
753
754 return ret;
755 }
756 EXPORT_SYMBOL_GPL(freq_qos_add_notifier);
757
758 /**
759 * freq_qos_remove_notifier - Remove frequency QoS change notifier.
760 * @qos: List of requests to remove the notifier from.
761 * @type: Request type.
762 * @notifier: Notifier block to remove.
763 */
freq_qos_remove_notifier(struct freq_constraints * qos,enum freq_qos_req_type type,struct notifier_block * notifier)764 int freq_qos_remove_notifier(struct freq_constraints *qos,
765 enum freq_qos_req_type type,
766 struct notifier_block *notifier)
767 {
768 int ret;
769
770 if (IS_ERR_OR_NULL(qos) || !notifier)
771 return -EINVAL;
772
773 switch (type) {
774 case FREQ_QOS_MIN:
775 ret = blocking_notifier_chain_unregister(qos->min_freq.notifiers,
776 notifier);
777 break;
778 case FREQ_QOS_MAX:
779 ret = blocking_notifier_chain_unregister(qos->max_freq.notifiers,
780 notifier);
781 break;
782 default:
783 WARN_ON(1);
784 ret = -EINVAL;
785 }
786
787 return ret;
788 }
789 EXPORT_SYMBOL_GPL(freq_qos_remove_notifier);
790