]> git.proxmox.com Git - mirror_ubuntu-focal-kernel.git/blame - drivers/cpufreq/cpufreq.c
cpufreq: Avoid false-positive WARN_ON()s in cpufreq_update_policy()
[mirror_ubuntu-focal-kernel.git] / drivers / cpufreq / cpufreq.c
CommitLineData
1da177e4
LT
1/*
2 * linux/drivers/cpufreq/cpufreq.c
3 *
4 * Copyright (C) 2001 Russell King
5 * (C) 2002 - 2003 Dominik Brodowski <linux@brodo.de>
bb176f7d 6 * (C) 2013 Viresh Kumar <viresh.kumar@linaro.org>
1da177e4 7 *
c32b6b8e 8 * Oct 2005 - Ashok Raj <ashok.raj@intel.com>
32ee8c3e 9 * Added handling for CPU hotplug
8ff69732
DJ
10 * Feb 2006 - Jacob Shin <jacob.shin@amd.com>
11 * Fix handling for CPU hotplug -- affected CPUs
c32b6b8e 12 *
1da177e4
LT
13 * This program is free software; you can redistribute it and/or modify
14 * it under the terms of the GNU General Public License version 2 as
15 * published by the Free Software Foundation.
1da177e4
LT
16 */
17
db701151
VK
18#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
19
5ff0a268 20#include <linux/cpu.h>
1da177e4
LT
21#include <linux/cpufreq.h>
22#include <linux/delay.h>
1da177e4 23#include <linux/device.h>
5ff0a268
VK
24#include <linux/init.h>
25#include <linux/kernel_stat.h>
26#include <linux/module.h>
3fc54d37 27#include <linux/mutex.h>
5ff0a268 28#include <linux/slab.h>
2f0aea93 29#include <linux/suspend.h>
90de2a4a 30#include <linux/syscore_ops.h>
5ff0a268 31#include <linux/tick.h>
6f4f2723
TR
32#include <trace/events/power.h>
33
b4f0676f 34static LIST_HEAD(cpufreq_policy_list);
f963735a
VK
35
36static inline bool policy_is_inactive(struct cpufreq_policy *policy)
37{
38 return cpumask_empty(policy->cpus);
39}
40
f963735a 41/* Macros to iterate over CPU policies */
fd7dc7e6
EB
42#define for_each_suitable_policy(__policy, __active) \
43 list_for_each_entry(__policy, &cpufreq_policy_list, policy_list) \
44 if ((__active) == !policy_is_inactive(__policy))
f963735a
VK
45
46#define for_each_active_policy(__policy) \
47 for_each_suitable_policy(__policy, true)
48#define for_each_inactive_policy(__policy) \
49 for_each_suitable_policy(__policy, false)
50
51#define for_each_policy(__policy) \
b4f0676f
VK
52 list_for_each_entry(__policy, &cpufreq_policy_list, policy_list)
53
f7b27061
VK
54/* Iterate over governors */
55static LIST_HEAD(cpufreq_governor_list);
56#define for_each_governor(__governor) \
57 list_for_each_entry(__governor, &cpufreq_governor_list, governor_list)
58
1da177e4 59/**
cd878479 60 * The "cpufreq driver" - the arch- or hardware-dependent low
1da177e4
LT
61 * level driver of CPUFreq support, and its spinlock. This lock
62 * also protects the cpufreq_cpu_data array.
63 */
1c3d85dd 64static struct cpufreq_driver *cpufreq_driver;
7a6aedfa 65static DEFINE_PER_CPU(struct cpufreq_policy *, cpufreq_cpu_data);
bb176f7d 66static DEFINE_RWLOCK(cpufreq_driver_lock);
bb176f7d 67
2f0aea93
VK
68/* Flag to suspend/resume CPUFreq governors */
69static bool cpufreq_suspended;
1da177e4 70
9c0ebcf7
VK
71static inline bool has_target(void)
72{
73 return cpufreq_driver->target_index || cpufreq_driver->target;
74}
75
1da177e4 76/* internal prototypes */
a1317e09 77static int cpufreq_governor(struct cpufreq_policy *policy, unsigned int event);
d92d50a4 78static unsigned int __cpufreq_get(struct cpufreq_policy *policy);
0a300767 79static int cpufreq_start_governor(struct cpufreq_policy *policy);
1da177e4 80
36be3418 81static inline void cpufreq_exit_governor(struct cpufreq_policy *policy)
6c9d9c81 82{
36be3418 83 (void)cpufreq_governor(policy, CPUFREQ_GOV_POLICY_EXIT);
6c9d9c81 84}
1da177e4 85
45482c70
RW
86static inline void cpufreq_stop_governor(struct cpufreq_policy *policy)
87{
88 (void)cpufreq_governor(policy, CPUFREQ_GOV_STOP);
89}
90
1da177e4 91/**
32ee8c3e
DJ
92 * Two notifier lists: the "policy" list is involved in the
93 * validation process for a new CPU frequency policy; the
1da177e4
LT
94 * "transition" list for kernel code that needs to handle
95 * changes to devices when the CPU clock speed changes.
96 * The mutex locks both lists.
97 */
e041c683 98static BLOCKING_NOTIFIER_HEAD(cpufreq_policy_notifier_list);
b4dfdbb3 99static struct srcu_notifier_head cpufreq_transition_notifier_list;
1da177e4 100
74212ca4 101static bool init_cpufreq_transition_notifier_list_called;
b4dfdbb3
AS
102static int __init init_cpufreq_transition_notifier_list(void)
103{
104 srcu_init_notifier_head(&cpufreq_transition_notifier_list);
74212ca4 105 init_cpufreq_transition_notifier_list_called = true;
b4dfdbb3
AS
106 return 0;
107}
b3438f82 108pure_initcall(init_cpufreq_transition_notifier_list);
1da177e4 109
a7b422cd 110static int off __read_mostly;
da584455 111static int cpufreq_disabled(void)
a7b422cd
KRW
112{
113 return off;
114}
115void disable_cpufreq(void)
116{
117 off = 1;
118}
29464f28 119static DEFINE_MUTEX(cpufreq_governor_mutex);
1da177e4 120
4d5dcc42
VK
121bool have_governor_per_policy(void)
122{
0b981e70 123 return !!(cpufreq_driver->flags & CPUFREQ_HAVE_GOVERNOR_PER_POLICY);
4d5dcc42 124}
3f869d6d 125EXPORT_SYMBOL_GPL(have_governor_per_policy);
4d5dcc42 126
944e9a03
VK
127struct kobject *get_governor_parent_kobj(struct cpufreq_policy *policy)
128{
129 if (have_governor_per_policy())
130 return &policy->kobj;
131 else
132 return cpufreq_global_kobject;
133}
134EXPORT_SYMBOL_GPL(get_governor_parent_kobj);
135
5a31d594
VK
136struct cpufreq_frequency_table *cpufreq_frequency_get_table(unsigned int cpu)
137{
138 struct cpufreq_policy *policy = per_cpu(cpufreq_cpu_data, cpu);
139
140 return policy && !policy_is_inactive(policy) ?
141 policy->freq_table : NULL;
142}
143EXPORT_SYMBOL_GPL(cpufreq_frequency_get_table);
144
72a4ce34
VK
145static inline u64 get_cpu_idle_time_jiffy(unsigned int cpu, u64 *wall)
146{
147 u64 idle_time;
148 u64 cur_wall_time;
149 u64 busy_time;
150
151 cur_wall_time = jiffies64_to_cputime64(get_jiffies_64());
152
153 busy_time = kcpustat_cpu(cpu).cpustat[CPUTIME_USER];
154 busy_time += kcpustat_cpu(cpu).cpustat[CPUTIME_SYSTEM];
155 busy_time += kcpustat_cpu(cpu).cpustat[CPUTIME_IRQ];
156 busy_time += kcpustat_cpu(cpu).cpustat[CPUTIME_SOFTIRQ];
157 busy_time += kcpustat_cpu(cpu).cpustat[CPUTIME_STEAL];
158 busy_time += kcpustat_cpu(cpu).cpustat[CPUTIME_NICE];
159
160 idle_time = cur_wall_time - busy_time;
161 if (wall)
162 *wall = cputime_to_usecs(cur_wall_time);
163
164 return cputime_to_usecs(idle_time);
165}
166
167u64 get_cpu_idle_time(unsigned int cpu, u64 *wall, int io_busy)
168{
169 u64 idle_time = get_cpu_idle_time_us(cpu, io_busy ? wall : NULL);
170
171 if (idle_time == -1ULL)
172 return get_cpu_idle_time_jiffy(cpu, wall);
173 else if (!io_busy)
174 idle_time += get_cpu_iowait_time_us(cpu, wall);
175
176 return idle_time;
177}
178EXPORT_SYMBOL_GPL(get_cpu_idle_time);
179
70e9e778
VK
180/*
181 * This is a generic cpufreq init() routine which can be used by cpufreq
182 * drivers of SMP systems. It will do following:
183 * - validate & show freq table passed
184 * - set policies transition latency
185 * - policy->cpus with all possible CPUs
186 */
187int cpufreq_generic_init(struct cpufreq_policy *policy,
188 struct cpufreq_frequency_table *table,
189 unsigned int transition_latency)
190{
191 int ret;
192
193 ret = cpufreq_table_validate_and_show(policy, table);
194 if (ret) {
195 pr_err("%s: invalid frequency table: %d\n", __func__, ret);
196 return ret;
197 }
198
199 policy->cpuinfo.transition_latency = transition_latency;
200
201 /*
58405af6 202 * The driver only supports the SMP configuration where all processors
70e9e778
VK
203 * share the clock and voltage and clock.
204 */
205 cpumask_setall(policy->cpus);
206
207 return 0;
208}
209EXPORT_SYMBOL_GPL(cpufreq_generic_init);
210
1f0bd44e 211struct cpufreq_policy *cpufreq_cpu_get_raw(unsigned int cpu)
652ed95d
VK
212{
213 struct cpufreq_policy *policy = per_cpu(cpufreq_cpu_data, cpu);
214
988bed09
VK
215 return policy && cpumask_test_cpu(cpu, policy->cpus) ? policy : NULL;
216}
1f0bd44e 217EXPORT_SYMBOL_GPL(cpufreq_cpu_get_raw);
988bed09
VK
218
219unsigned int cpufreq_generic_get(unsigned int cpu)
220{
221 struct cpufreq_policy *policy = cpufreq_cpu_get_raw(cpu);
222
652ed95d 223 if (!policy || IS_ERR(policy->clk)) {
e837f9b5
JP
224 pr_err("%s: No %s associated to cpu: %d\n",
225 __func__, policy ? "clk" : "policy", cpu);
652ed95d
VK
226 return 0;
227 }
228
229 return clk_get_rate(policy->clk) / 1000;
230}
231EXPORT_SYMBOL_GPL(cpufreq_generic_get);
232
50e9c852
VK
233/**
234 * cpufreq_cpu_get: returns policy for a cpu and marks it busy.
235 *
236 * @cpu: cpu to find policy for.
237 *
238 * This returns policy for 'cpu', returns NULL if it doesn't exist.
239 * It also increments the kobject reference count to mark it busy and so would
240 * require a corresponding call to cpufreq_cpu_put() to decrement it back.
241 * If corresponding call cpufreq_cpu_put() isn't made, the policy wouldn't be
242 * freed as that depends on the kobj count.
243 *
50e9c852
VK
244 * Return: A valid policy on success, otherwise NULL on failure.
245 */
6eed9404 246struct cpufreq_policy *cpufreq_cpu_get(unsigned int cpu)
1da177e4 247{
6eed9404 248 struct cpufreq_policy *policy = NULL;
1da177e4
LT
249 unsigned long flags;
250
1b947c90 251 if (WARN_ON(cpu >= nr_cpu_ids))
6eed9404
VK
252 return NULL;
253
1da177e4 254 /* get the cpufreq driver */
1c3d85dd 255 read_lock_irqsave(&cpufreq_driver_lock, flags);
1da177e4 256
6eed9404
VK
257 if (cpufreq_driver) {
258 /* get the CPU */
988bed09 259 policy = cpufreq_cpu_get_raw(cpu);
6eed9404
VK
260 if (policy)
261 kobject_get(&policy->kobj);
262 }
1da177e4 263
6eed9404 264 read_unlock_irqrestore(&cpufreq_driver_lock, flags);
1da177e4 265
3a3e9e06 266 return policy;
a9144436 267}
1da177e4
LT
268EXPORT_SYMBOL_GPL(cpufreq_cpu_get);
269
50e9c852
VK
270/**
271 * cpufreq_cpu_put: Decrements the usage count of a policy
272 *
273 * @policy: policy earlier returned by cpufreq_cpu_get().
274 *
275 * This decrements the kobject reference count incremented earlier by calling
276 * cpufreq_cpu_get().
50e9c852 277 */
3a3e9e06 278void cpufreq_cpu_put(struct cpufreq_policy *policy)
1da177e4 279{
6eed9404 280 kobject_put(&policy->kobj);
1da177e4
LT
281}
282EXPORT_SYMBOL_GPL(cpufreq_cpu_put);
283
1da177e4
LT
284/*********************************************************************
285 * EXTERNALLY AFFECTING FREQUENCY CHANGES *
286 *********************************************************************/
287
288/**
289 * adjust_jiffies - adjust the system "loops_per_jiffy"
290 *
291 * This function alters the system "loops_per_jiffy" for the clock
292 * speed change. Note that loops_per_jiffy cannot be updated on SMP
32ee8c3e 293 * systems as each CPU might be scaled differently. So, use the arch
1da177e4
LT
294 * per-CPU loops_per_jiffy value wherever possible.
295 */
858119e1 296static void adjust_jiffies(unsigned long val, struct cpufreq_freqs *ci)
1da177e4 297{
39c132ee
VK
298#ifndef CONFIG_SMP
299 static unsigned long l_p_j_ref;
300 static unsigned int l_p_j_ref_freq;
301
1da177e4
LT
302 if (ci->flags & CPUFREQ_CONST_LOOPS)
303 return;
304
305 if (!l_p_j_ref_freq) {
306 l_p_j_ref = loops_per_jiffy;
307 l_p_j_ref_freq = ci->old;
e837f9b5
JP
308 pr_debug("saving %lu as reference value for loops_per_jiffy; freq is %u kHz\n",
309 l_p_j_ref, l_p_j_ref_freq);
1da177e4 310 }
0b443ead 311 if (val == CPUFREQ_POSTCHANGE && ci->old != ci->new) {
e08f5f5b
GS
312 loops_per_jiffy = cpufreq_scale(l_p_j_ref, l_p_j_ref_freq,
313 ci->new);
e837f9b5
JP
314 pr_debug("scaling loops_per_jiffy to %lu for frequency %u kHz\n",
315 loops_per_jiffy, ci->new);
1da177e4 316 }
1da177e4 317#endif
39c132ee 318}
1da177e4 319
0956df9c 320static void __cpufreq_notify_transition(struct cpufreq_policy *policy,
b43a7ffb 321 struct cpufreq_freqs *freqs, unsigned int state)
1da177e4
LT
322{
323 BUG_ON(irqs_disabled());
324
d5aaffa9
DB
325 if (cpufreq_disabled())
326 return;
327
1c3d85dd 328 freqs->flags = cpufreq_driver->flags;
2d06d8c4 329 pr_debug("notification %u of frequency transition to %u kHz\n",
e837f9b5 330 state, freqs->new);
1da177e4 331
1da177e4 332 switch (state) {
e4472cb3 333
1da177e4 334 case CPUFREQ_PRECHANGE:
32ee8c3e 335 /* detect if the driver reported a value as "old frequency"
e4472cb3
DJ
336 * which is not equal to what the cpufreq core thinks is
337 * "old frequency".
1da177e4 338 */
1c3d85dd 339 if (!(cpufreq_driver->flags & CPUFREQ_CONST_LOOPS)) {
e4472cb3
DJ
340 if ((policy) && (policy->cpu == freqs->cpu) &&
341 (policy->cur) && (policy->cur != freqs->old)) {
e837f9b5
JP
342 pr_debug("Warning: CPU frequency is %u, cpufreq assumed %u kHz\n",
343 freqs->old, policy->cur);
e4472cb3 344 freqs->old = policy->cur;
1da177e4
LT
345 }
346 }
b4dfdbb3 347 srcu_notifier_call_chain(&cpufreq_transition_notifier_list,
e041c683 348 CPUFREQ_PRECHANGE, freqs);
1da177e4
LT
349 adjust_jiffies(CPUFREQ_PRECHANGE, freqs);
350 break;
e4472cb3 351
1da177e4
LT
352 case CPUFREQ_POSTCHANGE:
353 adjust_jiffies(CPUFREQ_POSTCHANGE, freqs);
e837f9b5
JP
354 pr_debug("FREQ: %lu - CPU: %lu\n",
355 (unsigned long)freqs->new, (unsigned long)freqs->cpu);
25e41933 356 trace_cpu_frequency(freqs->new, freqs->cpu);
b4dfdbb3 357 srcu_notifier_call_chain(&cpufreq_transition_notifier_list,
e041c683 358 CPUFREQ_POSTCHANGE, freqs);
e4472cb3
DJ
359 if (likely(policy) && likely(policy->cpu == freqs->cpu))
360 policy->cur = freqs->new;
1da177e4
LT
361 break;
362 }
1da177e4 363}
bb176f7d 364
b43a7ffb
VK
365/**
366 * cpufreq_notify_transition - call notifier chain and adjust_jiffies
367 * on frequency transition.
368 *
369 * This function calls the transition notifiers and the "adjust_jiffies"
370 * function. It is called twice on all CPU frequency changes that have
371 * external effects.
372 */
236a9800 373static void cpufreq_notify_transition(struct cpufreq_policy *policy,
b43a7ffb
VK
374 struct cpufreq_freqs *freqs, unsigned int state)
375{
376 for_each_cpu(freqs->cpu, policy->cpus)
377 __cpufreq_notify_transition(policy, freqs, state);
378}
1da177e4 379
f7ba3b41 380/* Do post notifications when there are chances that transition has failed */
236a9800 381static void cpufreq_notify_post_transition(struct cpufreq_policy *policy,
f7ba3b41
VK
382 struct cpufreq_freqs *freqs, int transition_failed)
383{
384 cpufreq_notify_transition(policy, freqs, CPUFREQ_POSTCHANGE);
385 if (!transition_failed)
386 return;
387
388 swap(freqs->old, freqs->new);
389 cpufreq_notify_transition(policy, freqs, CPUFREQ_PRECHANGE);
390 cpufreq_notify_transition(policy, freqs, CPUFREQ_POSTCHANGE);
391}
f7ba3b41 392
12478cf0
SB
393void cpufreq_freq_transition_begin(struct cpufreq_policy *policy,
394 struct cpufreq_freqs *freqs)
395{
ca654dc3
SB
396
397 /*
398 * Catch double invocations of _begin() which lead to self-deadlock.
399 * ASYNC_NOTIFICATION drivers are left out because the cpufreq core
400 * doesn't invoke _begin() on their behalf, and hence the chances of
401 * double invocations are very low. Moreover, there are scenarios
402 * where these checks can emit false-positive warnings in these
403 * drivers; so we avoid that by skipping them altogether.
404 */
405 WARN_ON(!(cpufreq_driver->flags & CPUFREQ_ASYNC_NOTIFICATION)
406 && current == policy->transition_task);
407
12478cf0
SB
408wait:
409 wait_event(policy->transition_wait, !policy->transition_ongoing);
410
411 spin_lock(&policy->transition_lock);
412
413 if (unlikely(policy->transition_ongoing)) {
414 spin_unlock(&policy->transition_lock);
415 goto wait;
416 }
417
418 policy->transition_ongoing = true;
ca654dc3 419 policy->transition_task = current;
12478cf0
SB
420
421 spin_unlock(&policy->transition_lock);
422
423 cpufreq_notify_transition(policy, freqs, CPUFREQ_PRECHANGE);
424}
425EXPORT_SYMBOL_GPL(cpufreq_freq_transition_begin);
426
427void cpufreq_freq_transition_end(struct cpufreq_policy *policy,
428 struct cpufreq_freqs *freqs, int transition_failed)
429{
430 if (unlikely(WARN_ON(!policy->transition_ongoing)))
431 return;
432
433 cpufreq_notify_post_transition(policy, freqs, transition_failed);
434
435 policy->transition_ongoing = false;
ca654dc3 436 policy->transition_task = NULL;
12478cf0
SB
437
438 wake_up(&policy->transition_wait);
439}
440EXPORT_SYMBOL_GPL(cpufreq_freq_transition_end);
441
b7898fda
RW
442/*
443 * Fast frequency switching status count. Positive means "enabled", negative
444 * means "disabled" and 0 means "not decided yet".
445 */
446static int cpufreq_fast_switch_count;
447static DEFINE_MUTEX(cpufreq_fast_switch_lock);
448
449static void cpufreq_list_transition_notifiers(void)
450{
451 struct notifier_block *nb;
452
453 pr_info("Registered transition notifiers:\n");
454
455 mutex_lock(&cpufreq_transition_notifier_list.mutex);
456
457 for (nb = cpufreq_transition_notifier_list.head; nb; nb = nb->next)
458 pr_info("%pF\n", nb->notifier_call);
459
460 mutex_unlock(&cpufreq_transition_notifier_list.mutex);
461}
462
463/**
464 * cpufreq_enable_fast_switch - Enable fast frequency switching for policy.
465 * @policy: cpufreq policy to enable fast frequency switching for.
466 *
467 * Try to enable fast frequency switching for @policy.
468 *
469 * The attempt will fail if there is at least one transition notifier registered
470 * at this point, as fast frequency switching is quite fundamentally at odds
471 * with transition notifiers. Thus if successful, it will make registration of
472 * transition notifiers fail going forward.
473 */
474void cpufreq_enable_fast_switch(struct cpufreq_policy *policy)
475{
476 lockdep_assert_held(&policy->rwsem);
477
478 if (!policy->fast_switch_possible)
479 return;
480
481 mutex_lock(&cpufreq_fast_switch_lock);
482 if (cpufreq_fast_switch_count >= 0) {
483 cpufreq_fast_switch_count++;
484 policy->fast_switch_enabled = true;
485 } else {
486 pr_warn("CPU%u: Fast frequency switching not enabled\n",
487 policy->cpu);
488 cpufreq_list_transition_notifiers();
489 }
490 mutex_unlock(&cpufreq_fast_switch_lock);
491}
492EXPORT_SYMBOL_GPL(cpufreq_enable_fast_switch);
493
6c9d9c81
RW
494/**
495 * cpufreq_disable_fast_switch - Disable fast frequency switching for policy.
496 * @policy: cpufreq policy to disable fast frequency switching for.
497 */
498void cpufreq_disable_fast_switch(struct cpufreq_policy *policy)
b7898fda
RW
499{
500 mutex_lock(&cpufreq_fast_switch_lock);
501 if (policy->fast_switch_enabled) {
502 policy->fast_switch_enabled = false;
503 if (!WARN_ON(cpufreq_fast_switch_count <= 0))
504 cpufreq_fast_switch_count--;
505 }
506 mutex_unlock(&cpufreq_fast_switch_lock);
507}
6c9d9c81 508EXPORT_SYMBOL_GPL(cpufreq_disable_fast_switch);
1da177e4 509
1da177e4
LT
510/*********************************************************************
511 * SYSFS INTERFACE *
512 *********************************************************************/
8a5c74a1 513static ssize_t show_boost(struct kobject *kobj,
6f19efc0
LM
514 struct attribute *attr, char *buf)
515{
516 return sprintf(buf, "%d\n", cpufreq_driver->boost_enabled);
517}
518
519static ssize_t store_boost(struct kobject *kobj, struct attribute *attr,
520 const char *buf, size_t count)
521{
522 int ret, enable;
523
524 ret = sscanf(buf, "%d", &enable);
525 if (ret != 1 || enable < 0 || enable > 1)
526 return -EINVAL;
527
528 if (cpufreq_boost_trigger_state(enable)) {
e837f9b5
JP
529 pr_err("%s: Cannot %s BOOST!\n",
530 __func__, enable ? "enable" : "disable");
6f19efc0
LM
531 return -EINVAL;
532 }
533
e837f9b5
JP
534 pr_debug("%s: cpufreq BOOST %s\n",
535 __func__, enable ? "enabled" : "disabled");
6f19efc0
LM
536
537 return count;
538}
539define_one_global_rw(boost);
1da177e4 540
42f91fa1 541static struct cpufreq_governor *find_governor(const char *str_governor)
3bcb09a3
JF
542{
543 struct cpufreq_governor *t;
544
f7b27061 545 for_each_governor(t)
7c4f4539 546 if (!strncasecmp(str_governor, t->name, CPUFREQ_NAME_LEN))
3bcb09a3
JF
547 return t;
548
549 return NULL;
550}
551
1da177e4
LT
552/**
553 * cpufreq_parse_governor - parse a governor string
554 */
905d77cd 555static int cpufreq_parse_governor(char *str_governor, unsigned int *policy,
1da177e4
LT
556 struct cpufreq_governor **governor)
557{
3bcb09a3 558 int err = -EINVAL;
1c3d85dd 559
1c3d85dd 560 if (cpufreq_driver->setpolicy) {
7c4f4539 561 if (!strncasecmp(str_governor, "performance", CPUFREQ_NAME_LEN)) {
1da177e4 562 *policy = CPUFREQ_POLICY_PERFORMANCE;
3bcb09a3 563 err = 0;
7c4f4539 564 } else if (!strncasecmp(str_governor, "powersave",
e08f5f5b 565 CPUFREQ_NAME_LEN)) {
1da177e4 566 *policy = CPUFREQ_POLICY_POWERSAVE;
3bcb09a3 567 err = 0;
1da177e4 568 }
2e1cc3a5 569 } else {
1da177e4 570 struct cpufreq_governor *t;
3bcb09a3 571
3fc54d37 572 mutex_lock(&cpufreq_governor_mutex);
3bcb09a3 573
42f91fa1 574 t = find_governor(str_governor);
3bcb09a3 575
ea714970 576 if (t == NULL) {
1a8e1463 577 int ret;
ea714970 578
1a8e1463
KC
579 mutex_unlock(&cpufreq_governor_mutex);
580 ret = request_module("cpufreq_%s", str_governor);
581 mutex_lock(&cpufreq_governor_mutex);
ea714970 582
1a8e1463 583 if (ret == 0)
42f91fa1 584 t = find_governor(str_governor);
ea714970
JF
585 }
586
3bcb09a3
JF
587 if (t != NULL) {
588 *governor = t;
589 err = 0;
1da177e4 590 }
3bcb09a3 591
3fc54d37 592 mutex_unlock(&cpufreq_governor_mutex);
1da177e4 593 }
3bcb09a3 594 return err;
1da177e4 595}
1da177e4 596
1da177e4 597/**
e08f5f5b
GS
598 * cpufreq_per_cpu_attr_read() / show_##file_name() -
599 * print out cpufreq information
1da177e4
LT
600 *
601 * Write out information from cpufreq_driver->policy[cpu]; object must be
602 * "unsigned int".
603 */
604
32ee8c3e
DJ
605#define show_one(file_name, object) \
606static ssize_t show_##file_name \
905d77cd 607(struct cpufreq_policy *policy, char *buf) \
32ee8c3e 608{ \
29464f28 609 return sprintf(buf, "%u\n", policy->object); \
1da177e4
LT
610}
611
612show_one(cpuinfo_min_freq, cpuinfo.min_freq);
613show_one(cpuinfo_max_freq, cpuinfo.max_freq);
ed129784 614show_one(cpuinfo_transition_latency, cpuinfo.transition_latency);
1da177e4
LT
615show_one(scaling_min_freq, min);
616show_one(scaling_max_freq, max);
c034b02e 617
09347b29 618static ssize_t show_scaling_cur_freq(struct cpufreq_policy *policy, char *buf)
c034b02e
DB
619{
620 ssize_t ret;
621
622 if (cpufreq_driver && cpufreq_driver->setpolicy && cpufreq_driver->get)
623 ret = sprintf(buf, "%u\n", cpufreq_driver->get(policy->cpu));
624 else
625 ret = sprintf(buf, "%u\n", policy->cur);
626 return ret;
627}
1da177e4 628
037ce839 629static int cpufreq_set_policy(struct cpufreq_policy *policy,
3a3e9e06 630 struct cpufreq_policy *new_policy);
7970e08b 631
1da177e4
LT
632/**
633 * cpufreq_per_cpu_attr_write() / store_##file_name() - sysfs write access
634 */
635#define store_one(file_name, object) \
636static ssize_t store_##file_name \
905d77cd 637(struct cpufreq_policy *policy, const char *buf, size_t count) \
1da177e4 638{ \
619c144c 639 int ret, temp; \
1da177e4
LT
640 struct cpufreq_policy new_policy; \
641 \
8fa5b631 642 memcpy(&new_policy, policy, sizeof(*policy)); \
1da177e4 643 \
29464f28 644 ret = sscanf(buf, "%u", &new_policy.object); \
1da177e4
LT
645 if (ret != 1) \
646 return -EINVAL; \
647 \
619c144c 648 temp = new_policy.object; \
037ce839 649 ret = cpufreq_set_policy(policy, &new_policy); \
619c144c
VH
650 if (!ret) \
651 policy->user_policy.object = temp; \
1da177e4
LT
652 \
653 return ret ? ret : count; \
654}
655
29464f28
DJ
656store_one(scaling_min_freq, min);
657store_one(scaling_max_freq, max);
1da177e4
LT
658
659/**
660 * show_cpuinfo_cur_freq - current CPU frequency as detected by hardware
661 */
905d77cd
DJ
662static ssize_t show_cpuinfo_cur_freq(struct cpufreq_policy *policy,
663 char *buf)
1da177e4 664{
d92d50a4 665 unsigned int cur_freq = __cpufreq_get(policy);
1da177e4
LT
666 if (!cur_freq)
667 return sprintf(buf, "<unknown>");
668 return sprintf(buf, "%u\n", cur_freq);
669}
670
1da177e4
LT
671/**
672 * show_scaling_governor - show the current policy for the specified CPU
673 */
905d77cd 674static ssize_t show_scaling_governor(struct cpufreq_policy *policy, char *buf)
1da177e4 675{
29464f28 676 if (policy->policy == CPUFREQ_POLICY_POWERSAVE)
1da177e4
LT
677 return sprintf(buf, "powersave\n");
678 else if (policy->policy == CPUFREQ_POLICY_PERFORMANCE)
679 return sprintf(buf, "performance\n");
680 else if (policy->governor)
4b972f0b 681 return scnprintf(buf, CPUFREQ_NAME_PLEN, "%s\n",
29464f28 682 policy->governor->name);
1da177e4
LT
683 return -EINVAL;
684}
685
1da177e4
LT
686/**
687 * store_scaling_governor - store policy for the specified CPU
688 */
905d77cd
DJ
689static ssize_t store_scaling_governor(struct cpufreq_policy *policy,
690 const char *buf, size_t count)
1da177e4 691{
5136fa56 692 int ret;
1da177e4
LT
693 char str_governor[16];
694 struct cpufreq_policy new_policy;
695
8fa5b631 696 memcpy(&new_policy, policy, sizeof(*policy));
1da177e4 697
29464f28 698 ret = sscanf(buf, "%15s", str_governor);
1da177e4
LT
699 if (ret != 1)
700 return -EINVAL;
701
e08f5f5b
GS
702 if (cpufreq_parse_governor(str_governor, &new_policy.policy,
703 &new_policy.governor))
1da177e4
LT
704 return -EINVAL;
705
037ce839 706 ret = cpufreq_set_policy(policy, &new_policy);
88dc4384 707 return ret ? ret : count;
1da177e4
LT
708}
709
710/**
711 * show_scaling_driver - show the cpufreq driver currently loaded
712 */
905d77cd 713static ssize_t show_scaling_driver(struct cpufreq_policy *policy, char *buf)
1da177e4 714{
1c3d85dd 715 return scnprintf(buf, CPUFREQ_NAME_PLEN, "%s\n", cpufreq_driver->name);
1da177e4
LT
716}
717
718/**
719 * show_scaling_available_governors - show the available CPUfreq governors
720 */
905d77cd
DJ
721static ssize_t show_scaling_available_governors(struct cpufreq_policy *policy,
722 char *buf)
1da177e4
LT
723{
724 ssize_t i = 0;
725 struct cpufreq_governor *t;
726
9c0ebcf7 727 if (!has_target()) {
1da177e4
LT
728 i += sprintf(buf, "performance powersave");
729 goto out;
730 }
731
f7b27061 732 for_each_governor(t) {
29464f28
DJ
733 if (i >= (ssize_t) ((PAGE_SIZE / sizeof(char))
734 - (CPUFREQ_NAME_LEN + 2)))
1da177e4 735 goto out;
4b972f0b 736 i += scnprintf(&buf[i], CPUFREQ_NAME_PLEN, "%s ", t->name);
1da177e4 737 }
7d5e350f 738out:
1da177e4
LT
739 i += sprintf(&buf[i], "\n");
740 return i;
741}
e8628dd0 742
f4fd3797 743ssize_t cpufreq_show_cpus(const struct cpumask *mask, char *buf)
1da177e4
LT
744{
745 ssize_t i = 0;
746 unsigned int cpu;
747
835481d9 748 for_each_cpu(cpu, mask) {
1da177e4
LT
749 if (i)
750 i += scnprintf(&buf[i], (PAGE_SIZE - i - 2), " ");
751 i += scnprintf(&buf[i], (PAGE_SIZE - i - 2), "%u", cpu);
752 if (i >= (PAGE_SIZE - 5))
29464f28 753 break;
1da177e4
LT
754 }
755 i += sprintf(&buf[i], "\n");
756 return i;
757}
f4fd3797 758EXPORT_SYMBOL_GPL(cpufreq_show_cpus);
1da177e4 759
e8628dd0
DW
760/**
761 * show_related_cpus - show the CPUs affected by each transition even if
762 * hw coordination is in use
763 */
764static ssize_t show_related_cpus(struct cpufreq_policy *policy, char *buf)
765{
f4fd3797 766 return cpufreq_show_cpus(policy->related_cpus, buf);
e8628dd0
DW
767}
768
769/**
770 * show_affected_cpus - show the CPUs affected by each transition
771 */
772static ssize_t show_affected_cpus(struct cpufreq_policy *policy, char *buf)
773{
f4fd3797 774 return cpufreq_show_cpus(policy->cpus, buf);
e8628dd0
DW
775}
776
9e76988e 777static ssize_t store_scaling_setspeed(struct cpufreq_policy *policy,
905d77cd 778 const char *buf, size_t count)
9e76988e
VP
779{
780 unsigned int freq = 0;
781 unsigned int ret;
782
879000f9 783 if (!policy->governor || !policy->governor->store_setspeed)
9e76988e
VP
784 return -EINVAL;
785
786 ret = sscanf(buf, "%u", &freq);
787 if (ret != 1)
788 return -EINVAL;
789
790 policy->governor->store_setspeed(policy, freq);
791
792 return count;
793}
794
795static ssize_t show_scaling_setspeed(struct cpufreq_policy *policy, char *buf)
796{
879000f9 797 if (!policy->governor || !policy->governor->show_setspeed)
9e76988e
VP
798 return sprintf(buf, "<unsupported>\n");
799
800 return policy->governor->show_setspeed(policy, buf);
801}
1da177e4 802
e2f74f35 803/**
8bf1ac72 804 * show_bios_limit - show the current cpufreq HW/BIOS limitation
e2f74f35
TR
805 */
806static ssize_t show_bios_limit(struct cpufreq_policy *policy, char *buf)
807{
808 unsigned int limit;
809 int ret;
1c3d85dd
RW
810 if (cpufreq_driver->bios_limit) {
811 ret = cpufreq_driver->bios_limit(policy->cpu, &limit);
e2f74f35
TR
812 if (!ret)
813 return sprintf(buf, "%u\n", limit);
814 }
815 return sprintf(buf, "%u\n", policy->cpuinfo.max_freq);
816}
817
6dad2a29
BP
818cpufreq_freq_attr_ro_perm(cpuinfo_cur_freq, 0400);
819cpufreq_freq_attr_ro(cpuinfo_min_freq);
820cpufreq_freq_attr_ro(cpuinfo_max_freq);
821cpufreq_freq_attr_ro(cpuinfo_transition_latency);
822cpufreq_freq_attr_ro(scaling_available_governors);
823cpufreq_freq_attr_ro(scaling_driver);
824cpufreq_freq_attr_ro(scaling_cur_freq);
825cpufreq_freq_attr_ro(bios_limit);
826cpufreq_freq_attr_ro(related_cpus);
827cpufreq_freq_attr_ro(affected_cpus);
828cpufreq_freq_attr_rw(scaling_min_freq);
829cpufreq_freq_attr_rw(scaling_max_freq);
830cpufreq_freq_attr_rw(scaling_governor);
831cpufreq_freq_attr_rw(scaling_setspeed);
1da177e4 832
905d77cd 833static struct attribute *default_attrs[] = {
1da177e4
LT
834 &cpuinfo_min_freq.attr,
835 &cpuinfo_max_freq.attr,
ed129784 836 &cpuinfo_transition_latency.attr,
1da177e4
LT
837 &scaling_min_freq.attr,
838 &scaling_max_freq.attr,
839 &affected_cpus.attr,
e8628dd0 840 &related_cpus.attr,
1da177e4
LT
841 &scaling_governor.attr,
842 &scaling_driver.attr,
843 &scaling_available_governors.attr,
9e76988e 844 &scaling_setspeed.attr,
1da177e4
LT
845 NULL
846};
847
29464f28
DJ
848#define to_policy(k) container_of(k, struct cpufreq_policy, kobj)
849#define to_attr(a) container_of(a, struct freq_attr, attr)
1da177e4 850
29464f28 851static ssize_t show(struct kobject *kobj, struct attribute *attr, char *buf)
1da177e4 852{
905d77cd
DJ
853 struct cpufreq_policy *policy = to_policy(kobj);
854 struct freq_attr *fattr = to_attr(attr);
1b750e3b 855 ssize_t ret;
6eed9404 856
ad7722da 857 down_read(&policy->rwsem);
6541aef0 858 ret = fattr->show(policy, buf);
ad7722da 859 up_read(&policy->rwsem);
1b750e3b 860
1da177e4
LT
861 return ret;
862}
863
905d77cd
DJ
864static ssize_t store(struct kobject *kobj, struct attribute *attr,
865 const char *buf, size_t count)
1da177e4 866{
905d77cd
DJ
867 struct cpufreq_policy *policy = to_policy(kobj);
868 struct freq_attr *fattr = to_attr(attr);
a07530b4 869 ssize_t ret = -EINVAL;
6eed9404 870
4f750c93
SB
871 get_online_cpus();
872
6541aef0
RW
873 if (cpu_online(policy->cpu)) {
874 down_write(&policy->rwsem);
e08f5f5b 875 ret = fattr->store(policy, buf, count);
6541aef0
RW
876 up_write(&policy->rwsem);
877 }
e08f5f5b 878
4f750c93
SB
879 put_online_cpus();
880
1da177e4
LT
881 return ret;
882}
883
905d77cd 884static void cpufreq_sysfs_release(struct kobject *kobj)
1da177e4 885{
905d77cd 886 struct cpufreq_policy *policy = to_policy(kobj);
2d06d8c4 887 pr_debug("last reference is dropped\n");
1da177e4
LT
888 complete(&policy->kobj_unregister);
889}
890
52cf25d0 891static const struct sysfs_ops sysfs_ops = {
1da177e4
LT
892 .show = show,
893 .store = store,
894};
895
896static struct kobj_type ktype_cpufreq = {
897 .sysfs_ops = &sysfs_ops,
898 .default_attrs = default_attrs,
899 .release = cpufreq_sysfs_release,
900};
901
87549141
VK
902static int add_cpu_dev_symlink(struct cpufreq_policy *policy, int cpu)
903{
904 struct device *cpu_dev;
905
906 pr_debug("%s: Adding symlink for CPU: %u\n", __func__, cpu);
907
908 if (!policy)
909 return 0;
910
911 cpu_dev = get_cpu_device(cpu);
912 if (WARN_ON(!cpu_dev))
913 return 0;
914
915 return sysfs_create_link(&cpu_dev->kobj, &policy->kobj, "cpufreq");
916}
917
918static void remove_cpu_dev_symlink(struct cpufreq_policy *policy, int cpu)
919{
920 struct device *cpu_dev;
921
922 pr_debug("%s: Removing symlink for CPU: %u\n", __func__, cpu);
923
924 cpu_dev = get_cpu_device(cpu);
925 if (WARN_ON(!cpu_dev))
926 return;
927
928 sysfs_remove_link(&cpu_dev->kobj, "cpufreq");
929}
930
931/* Add/remove symlinks for all related CPUs */
308b60e7 932static int cpufreq_add_dev_symlink(struct cpufreq_policy *policy)
19d6f7ec
DJ
933{
934 unsigned int j;
935 int ret = 0;
936
87549141 937 /* Some related CPUs might not be present (physically hotplugged) */
559ed407 938 for_each_cpu(j, policy->real_cpus) {
87549141 939 ret = add_cpu_dev_symlink(policy, j);
71c3461e
RW
940 if (ret)
941 break;
19d6f7ec 942 }
87549141 943
19d6f7ec
DJ
944 return ret;
945}
946
87549141
VK
947static void cpufreq_remove_dev_symlink(struct cpufreq_policy *policy)
948{
949 unsigned int j;
950
951 /* Some related CPUs might not be present (physically hotplugged) */
96bdda61 952 for_each_cpu(j, policy->real_cpus)
87549141 953 remove_cpu_dev_symlink(policy, j);
87549141
VK
954}
955
d9612a49 956static int cpufreq_add_dev_interface(struct cpufreq_policy *policy)
909a694e
DJ
957{
958 struct freq_attr **drv_attr;
909a694e 959 int ret = 0;
909a694e 960
909a694e 961 /* set up files for this cpu device */
1c3d85dd 962 drv_attr = cpufreq_driver->attr;
f13f1184 963 while (drv_attr && *drv_attr) {
909a694e
DJ
964 ret = sysfs_create_file(&policy->kobj, &((*drv_attr)->attr));
965 if (ret)
6d4e81ed 966 return ret;
909a694e
DJ
967 drv_attr++;
968 }
1c3d85dd 969 if (cpufreq_driver->get) {
909a694e
DJ
970 ret = sysfs_create_file(&policy->kobj, &cpuinfo_cur_freq.attr);
971 if (ret)
6d4e81ed 972 return ret;
909a694e 973 }
c034b02e
DB
974
975 ret = sysfs_create_file(&policy->kobj, &scaling_cur_freq.attr);
976 if (ret)
6d4e81ed 977 return ret;
c034b02e 978
1c3d85dd 979 if (cpufreq_driver->bios_limit) {
e2f74f35
TR
980 ret = sysfs_create_file(&policy->kobj, &bios_limit.attr);
981 if (ret)
6d4e81ed 982 return ret;
e2f74f35 983 }
909a694e 984
6d4e81ed 985 return cpufreq_add_dev_symlink(policy);
e18f1682
SB
986}
987
de1df26b
RW
988__weak struct cpufreq_governor *cpufreq_default_governor(void)
989{
990 return NULL;
991}
992
7f0fa40f 993static int cpufreq_init_policy(struct cpufreq_policy *policy)
e18f1682 994{
6e2c89d1 995 struct cpufreq_governor *gov = NULL;
e18f1682 996 struct cpufreq_policy new_policy;
e18f1682 997
d5b73cd8 998 memcpy(&new_policy, policy, sizeof(*policy));
a27a9ab7 999
6e2c89d1 1000 /* Update governor of new_policy to the governor used before hotplug */
4573237b 1001 gov = find_governor(policy->last_governor);
de1df26b 1002 if (gov) {
6e2c89d1 1003 pr_debug("Restoring governor %s for cpu %d\n",
1004 policy->governor->name, policy->cpu);
de1df26b
RW
1005 } else {
1006 gov = cpufreq_default_governor();
1007 if (!gov)
1008 return -ENODATA;
1009 }
6e2c89d1 1010
1011 new_policy.governor = gov;
1012
69030dd1
SP
1013 /* Use the default policy if there is no last_policy. */
1014 if (cpufreq_driver->setpolicy) {
1015 if (policy->last_policy)
1016 new_policy.policy = policy->last_policy;
1017 else
1018 cpufreq_parse_governor(gov->name, &new_policy.policy,
1019 NULL);
1020 }
ecf7e461 1021 /* set default policy */
7f0fa40f 1022 return cpufreq_set_policy(policy, &new_policy);
909a694e
DJ
1023}
1024
d9612a49 1025static int cpufreq_add_policy_cpu(struct cpufreq_policy *policy, unsigned int cpu)
fcf80582 1026{
9c0ebcf7 1027 int ret = 0;
fcf80582 1028
bb29ae15
VK
1029 /* Has this CPU been taken care of already? */
1030 if (cpumask_test_cpu(cpu, policy->cpus))
1031 return 0;
1032
49f18560 1033 down_write(&policy->rwsem);
45482c70
RW
1034 if (has_target())
1035 cpufreq_stop_governor(policy);
fcf80582 1036
fcf80582 1037 cpumask_set_cpu(cpu, policy->cpus);
2eaa3e2d 1038
9c0ebcf7 1039 if (has_target()) {
0a300767 1040 ret = cpufreq_start_governor(policy);
49f18560 1041 if (ret)
3de9bdeb 1042 pr_err("%s: Failed to start governor\n", __func__);
820c6ca2 1043 }
49f18560
VK
1044 up_write(&policy->rwsem);
1045 return ret;
fcf80582 1046}
1da177e4 1047
11eb69b9
VK
1048static void handle_update(struct work_struct *work)
1049{
1050 struct cpufreq_policy *policy =
1051 container_of(work, struct cpufreq_policy, update);
1052 unsigned int cpu = policy->cpu;
1053 pr_debug("handle_update for cpu %u called\n", cpu);
1054 cpufreq_update_policy(cpu);
fcf80582 1055}
1da177e4 1056
a34e63b1 1057static struct cpufreq_policy *cpufreq_policy_alloc(unsigned int cpu)
e9698cc5 1058{
a34e63b1 1059 struct device *dev = get_cpu_device(cpu);
e9698cc5 1060 struct cpufreq_policy *policy;
edd4a893 1061 int ret;
e9698cc5 1062
a34e63b1
RW
1063 if (WARN_ON(!dev))
1064 return NULL;
1065
e9698cc5
SB
1066 policy = kzalloc(sizeof(*policy), GFP_KERNEL);
1067 if (!policy)
1068 return NULL;
1069
1070 if (!alloc_cpumask_var(&policy->cpus, GFP_KERNEL))
1071 goto err_free_policy;
1072
1073 if (!zalloc_cpumask_var(&policy->related_cpus, GFP_KERNEL))
1074 goto err_free_cpumask;
1075
559ed407
RW
1076 if (!zalloc_cpumask_var(&policy->real_cpus, GFP_KERNEL))
1077 goto err_free_rcpumask;
1078
edd4a893
VK
1079 ret = kobject_init_and_add(&policy->kobj, &ktype_cpufreq,
1080 cpufreq_global_kobject, "policy%u", cpu);
1081 if (ret) {
1082 pr_err("%s: failed to init policy->kobj: %d\n", __func__, ret);
1083 goto err_free_real_cpus;
1084 }
1085
c88a1f8b 1086 INIT_LIST_HEAD(&policy->policy_list);
ad7722da 1087 init_rwsem(&policy->rwsem);
12478cf0
SB
1088 spin_lock_init(&policy->transition_lock);
1089 init_waitqueue_head(&policy->transition_wait);
818c5712
VK
1090 init_completion(&policy->kobj_unregister);
1091 INIT_WORK(&policy->update, handle_update);
ad7722da 1092
a34e63b1 1093 policy->cpu = cpu;
e9698cc5
SB
1094 return policy;
1095
edd4a893
VK
1096err_free_real_cpus:
1097 free_cpumask_var(policy->real_cpus);
2fc3384d
VK
1098err_free_rcpumask:
1099 free_cpumask_var(policy->related_cpus);
e9698cc5
SB
1100err_free_cpumask:
1101 free_cpumask_var(policy->cpus);
1102err_free_policy:
1103 kfree(policy);
1104
1105 return NULL;
1106}
1107
2fc3384d 1108static void cpufreq_policy_put_kobj(struct cpufreq_policy *policy, bool notify)
42f921a6
VK
1109{
1110 struct kobject *kobj;
1111 struct completion *cmp;
1112
2fc3384d
VK
1113 if (notify)
1114 blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
1115 CPUFREQ_REMOVE_POLICY, policy);
fcd7af91 1116
87549141
VK
1117 down_write(&policy->rwsem);
1118 cpufreq_remove_dev_symlink(policy);
42f921a6
VK
1119 kobj = &policy->kobj;
1120 cmp = &policy->kobj_unregister;
87549141 1121 up_write(&policy->rwsem);
42f921a6
VK
1122 kobject_put(kobj);
1123
1124 /*
1125 * We need to make sure that the underlying kobj is
1126 * actually not referenced anymore by anybody before we
1127 * proceed with unloading.
1128 */
1129 pr_debug("waiting for dropping of refcount\n");
1130 wait_for_completion(cmp);
1131 pr_debug("wait complete\n");
1132}
1133
3654c5cc 1134static void cpufreq_policy_free(struct cpufreq_policy *policy, bool notify)
e9698cc5 1135{
988bed09
VK
1136 unsigned long flags;
1137 int cpu;
1138
1139 /* Remove policy from list */
1140 write_lock_irqsave(&cpufreq_driver_lock, flags);
1141 list_del(&policy->policy_list);
1142
1143 for_each_cpu(cpu, policy->related_cpus)
1144 per_cpu(cpufreq_cpu_data, cpu) = NULL;
1145 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
1146
3654c5cc 1147 cpufreq_policy_put_kobj(policy, notify);
559ed407 1148 free_cpumask_var(policy->real_cpus);
e9698cc5
SB
1149 free_cpumask_var(policy->related_cpus);
1150 free_cpumask_var(policy->cpus);
1151 kfree(policy);
1152}
1153
0b275352 1154static int cpufreq_online(unsigned int cpu)
1da177e4 1155{
7f0c020a 1156 struct cpufreq_policy *policy;
194d99c7 1157 bool new_policy;
1da177e4 1158 unsigned long flags;
0b275352
RW
1159 unsigned int j;
1160 int ret;
87549141 1161
0b275352 1162 pr_debug("%s: bringing CPU%u online\n", __func__, cpu);
6eed9404 1163
bb29ae15 1164 /* Check if this CPU already has a policy to manage it */
9104bb26 1165 policy = per_cpu(cpufreq_cpu_data, cpu);
11ce707e 1166 if (policy) {
9104bb26 1167 WARN_ON(!cpumask_test_cpu(cpu, policy->related_cpus));
11ce707e 1168 if (!policy_is_inactive(policy))
d9612a49 1169 return cpufreq_add_policy_cpu(policy, cpu);
1da177e4 1170
11ce707e 1171 /* This is the only online CPU for the policy. Start over. */
194d99c7 1172 new_policy = false;
11ce707e
RW
1173 down_write(&policy->rwsem);
1174 policy->cpu = cpu;
1175 policy->governor = NULL;
1176 up_write(&policy->rwsem);
1177 } else {
194d99c7 1178 new_policy = true;
a34e63b1 1179 policy = cpufreq_policy_alloc(cpu);
72368d12 1180 if (!policy)
d4d854d6 1181 return -ENOMEM;
72368d12 1182 }
0d66b91e 1183
835481d9 1184 cpumask_copy(policy->cpus, cpumask_of(cpu));
1da177e4 1185
1da177e4
LT
1186 /* call driver. From then on the cpufreq must be able
1187 * to accept all calls to ->verify and ->setpolicy for this CPU
1188 */
1c3d85dd 1189 ret = cpufreq_driver->init(policy);
1da177e4 1190 if (ret) {
2d06d8c4 1191 pr_debug("initialization failed\n");
8101f997 1192 goto out_free_policy;
1da177e4 1193 }
643ae6e8 1194
6d4e81ed
TV
1195 down_write(&policy->rwsem);
1196
194d99c7 1197 if (new_policy) {
4d1f3a5b 1198 /* related_cpus should at least include policy->cpus. */
0998a03a 1199 cpumask_copy(policy->related_cpus, policy->cpus);
4d1f3a5b 1200 /* Remember CPUs present at the policy creation time. */
559ed407 1201 cpumask_and(policy->real_cpus, policy->cpus, cpu_present_mask);
4d1f3a5b 1202 }
559ed407 1203
5a7e56a5
VK
1204 /*
1205 * affected cpus must always be the one, which are online. We aren't
1206 * managing offline cpus here.
1207 */
1208 cpumask_and(policy->cpus, policy->cpus, cpu_online_mask);
1209
194d99c7 1210 if (new_policy) {
5a7e56a5
VK
1211 policy->user_policy.min = policy->min;
1212 policy->user_policy.max = policy->max;
6d4e81ed 1213
988bed09
VK
1214 write_lock_irqsave(&cpufreq_driver_lock, flags);
1215 for_each_cpu(j, policy->related_cpus)
1216 per_cpu(cpufreq_cpu_data, j) = policy;
1217 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
1218 }
652ed95d 1219
2ed99e39 1220 if (cpufreq_driver->get && !cpufreq_driver->setpolicy) {
da60ce9f
VK
1221 policy->cur = cpufreq_driver->get(policy->cpu);
1222 if (!policy->cur) {
1223 pr_err("%s: ->get() failed\n", __func__);
8101f997 1224 goto out_exit_policy;
da60ce9f
VK
1225 }
1226 }
1227
d3916691
VK
1228 /*
1229 * Sometimes boot loaders set CPU frequency to a value outside of
1230 * frequency table present with cpufreq core. In such cases CPU might be
1231 * unstable if it has to run on that frequency for long duration of time
1232 * and so its better to set it to a frequency which is specified in
1233 * freq-table. This also makes cpufreq stats inconsistent as
1234 * cpufreq-stats would fail to register because current frequency of CPU
1235 * isn't found in freq-table.
1236 *
1237 * Because we don't want this change to effect boot process badly, we go
1238 * for the next freq which is >= policy->cur ('cur' must be set by now,
1239 * otherwise we will end up setting freq to lowest of the table as 'cur'
1240 * is initialized to zero).
1241 *
1242 * We are passing target-freq as "policy->cur - 1" otherwise
1243 * __cpufreq_driver_target() would simply fail, as policy->cur will be
1244 * equal to target-freq.
1245 */
1246 if ((cpufreq_driver->flags & CPUFREQ_NEED_INITIAL_FREQ_CHECK)
1247 && has_target()) {
1248 /* Are we running at unknown frequency ? */
1249 ret = cpufreq_frequency_table_get_index(policy, policy->cur);
1250 if (ret == -EINVAL) {
1251 /* Warn user and fix it */
1252 pr_warn("%s: CPU%d: Running at unlisted freq: %u KHz\n",
1253 __func__, policy->cpu, policy->cur);
1254 ret = __cpufreq_driver_target(policy, policy->cur - 1,
1255 CPUFREQ_RELATION_L);
1256
1257 /*
1258 * Reaching here after boot in a few seconds may not
1259 * mean that system will remain stable at "unknown"
1260 * frequency for longer duration. Hence, a BUG_ON().
1261 */
1262 BUG_ON(ret);
1263 pr_warn("%s: CPU%d: Unlisted initial frequency changed to: %u KHz\n",
1264 __func__, policy->cpu, policy->cur);
1265 }
1266 }
1267
a1531acd
TR
1268 blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
1269 CPUFREQ_START, policy);
1270
194d99c7 1271 if (new_policy) {
d9612a49 1272 ret = cpufreq_add_dev_interface(policy);
a82fab29 1273 if (ret)
8101f997 1274 goto out_exit_policy;
fcd7af91
VK
1275 blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
1276 CPUFREQ_CREATE_POLICY, policy);
8ff69732 1277
988bed09
VK
1278 write_lock_irqsave(&cpufreq_driver_lock, flags);
1279 list_add(&policy->policy_list, &cpufreq_policy_list);
1280 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
1281 }
9515f4d6 1282
7f0fa40f
VK
1283 ret = cpufreq_init_policy(policy);
1284 if (ret) {
1285 pr_err("%s: Failed to initialize policy for cpu: %d (%d)\n",
1286 __func__, cpu, ret);
194d99c7
RW
1287 /* cpufreq_policy_free() will notify based on this */
1288 new_policy = false;
1289 goto out_exit_policy;
08fd8c1c 1290 }
e18f1682 1291
4e97b631 1292 up_write(&policy->rwsem);
08fd8c1c 1293
038c5b3e 1294 kobject_uevent(&policy->kobj, KOBJ_ADD);
7c45cf31 1295
7c45cf31
VK
1296 /* Callback for handling stuff after policy is ready */
1297 if (cpufreq_driver->ready)
1298 cpufreq_driver->ready(policy);
1299
2d06d8c4 1300 pr_debug("initialization complete\n");
87c32271 1301
1da177e4
LT
1302 return 0;
1303
8101f997 1304out_exit_policy:
7106e02b
PB
1305 up_write(&policy->rwsem);
1306
da60ce9f
VK
1307 if (cpufreq_driver->exit)
1308 cpufreq_driver->exit(policy);
8101f997 1309out_free_policy:
194d99c7 1310 cpufreq_policy_free(policy, !new_policy);
1da177e4
LT
1311 return ret;
1312}
1313
0b275352
RW
1314/**
1315 * cpufreq_add_dev - the cpufreq interface for a CPU device.
1316 * @dev: CPU device.
1317 * @sif: Subsystem interface structure pointer (not used)
1318 */
1319static int cpufreq_add_dev(struct device *dev, struct subsys_interface *sif)
1320{
a794d613 1321 struct cpufreq_policy *policy;
0b275352 1322 unsigned cpu = dev->id;
0b275352
RW
1323
1324 dev_dbg(dev, "%s: adding CPU%u\n", __func__, cpu);
1325
a794d613
RW
1326 if (cpu_online(cpu))
1327 return cpufreq_online(cpu);
0b275352 1328
a794d613
RW
1329 /*
1330 * A hotplug notifier will follow and we will handle it as CPU online
1331 * then. For now, just create the sysfs link, unless there is no policy
1332 * or the link is already present.
1333 */
1334 policy = per_cpu(cpufreq_cpu_data, cpu);
1335 if (!policy || cpumask_test_and_set_cpu(cpu, policy->real_cpus))
1336 return 0;
6eed9404 1337
a794d613 1338 return add_cpu_dev_symlink(policy, cpu);
1da177e4
LT
1339}
1340
69cee714 1341static void cpufreq_offline(unsigned int cpu)
1da177e4 1342{
3a3e9e06 1343 struct cpufreq_policy *policy;
69cee714 1344 int ret;
1da177e4 1345
b8eed8af 1346 pr_debug("%s: unregistering CPU %u\n", __func__, cpu);
1da177e4 1347
988bed09 1348 policy = cpufreq_cpu_get_raw(cpu);
3a3e9e06 1349 if (!policy) {
b8eed8af 1350 pr_debug("%s: No cpu_data found\n", __func__);
15c0b4d2 1351 return;
1da177e4 1352 }
1da177e4 1353
49f18560 1354 down_write(&policy->rwsem);
45482c70
RW
1355 if (has_target())
1356 cpufreq_stop_governor(policy);
1da177e4 1357
9591becb 1358 cpumask_clear_cpu(cpu, policy->cpus);
4573237b 1359
9591becb
VK
1360 if (policy_is_inactive(policy)) {
1361 if (has_target())
1362 strncpy(policy->last_governor, policy->governor->name,
1363 CPUFREQ_NAME_LEN);
69030dd1
SP
1364 else
1365 policy->last_policy = policy->policy;
9591becb
VK
1366 } else if (cpu == policy->cpu) {
1367 /* Nominate new CPU */
1368 policy->cpu = cpumask_any(policy->cpus);
1369 }
084f3493 1370
9591becb
VK
1371 /* Start governor again for active policy */
1372 if (!policy_is_inactive(policy)) {
1373 if (has_target()) {
0a300767 1374 ret = cpufreq_start_governor(policy);
9591becb
VK
1375 if (ret)
1376 pr_err("%s: Failed to start governor\n", __func__);
1377 }
cedb70af 1378
49f18560 1379 goto unlock;
cedb70af
SB
1380 }
1381
69cee714
VK
1382 if (cpufreq_driver->stop_cpu)
1383 cpufreq_driver->stop_cpu(policy);
87549141 1384
36be3418
RW
1385 if (has_target())
1386 cpufreq_exit_governor(policy);
1da177e4 1387
87549141
VK
1388 /*
1389 * Perform the ->exit() even during light-weight tear-down,
1390 * since this is a core component, and is essential for the
1391 * subsequent light-weight ->init() to succeed.
1392 */
55582bcc 1393 if (cpufreq_driver->exit) {
87549141 1394 cpufreq_driver->exit(policy);
55582bcc
SP
1395 policy->freq_table = NULL;
1396 }
49f18560
VK
1397
1398unlock:
1399 up_write(&policy->rwsem);
1da177e4
LT
1400}
1401
cedb70af 1402/**
27a862e9 1403 * cpufreq_remove_dev - remove a CPU device
cedb70af
SB
1404 *
1405 * Removes the cpufreq interface for a CPU device.
cedb70af 1406 */
71db87ba 1407static void cpufreq_remove_dev(struct device *dev, struct subsys_interface *sif)
5a01f2e8 1408{
8a25a2fd 1409 unsigned int cpu = dev->id;
559ed407 1410 struct cpufreq_policy *policy = per_cpu(cpufreq_cpu_data, cpu);
87549141 1411
559ed407 1412 if (!policy)
1af115d6 1413 return;
87549141 1414
69cee714
VK
1415 if (cpu_online(cpu))
1416 cpufreq_offline(cpu);
87549141 1417
559ed407 1418 cpumask_clear_cpu(cpu, policy->real_cpus);
f344dae0 1419 remove_cpu_dev_symlink(policy, cpu);
87549141 1420
f344dae0 1421 if (cpumask_empty(policy->real_cpus))
3654c5cc 1422 cpufreq_policy_free(policy, true);
5a01f2e8
VP
1423}
1424
1da177e4 1425/**
bb176f7d
VK
1426 * cpufreq_out_of_sync - If actual and saved CPU frequency differs, we're
1427 * in deep trouble.
a1e1dc41 1428 * @policy: policy managing CPUs
1da177e4
LT
1429 * @new_freq: CPU frequency the CPU actually runs at
1430 *
29464f28
DJ
1431 * We adjust to current frequency first, and need to clean up later.
1432 * So either call to cpufreq_update_policy() or schedule handle_update()).
1da177e4 1433 */
a1e1dc41 1434static void cpufreq_out_of_sync(struct cpufreq_policy *policy,
e08f5f5b 1435 unsigned int new_freq)
1da177e4
LT
1436{
1437 struct cpufreq_freqs freqs;
b43a7ffb 1438
e837f9b5 1439 pr_debug("Warning: CPU frequency out of sync: cpufreq and timing core thinks of %u, is %u kHz\n",
a1e1dc41 1440 policy->cur, new_freq);
1da177e4 1441
a1e1dc41 1442 freqs.old = policy->cur;
1da177e4 1443 freqs.new = new_freq;
b43a7ffb 1444
8fec051e
VK
1445 cpufreq_freq_transition_begin(policy, &freqs);
1446 cpufreq_freq_transition_end(policy, &freqs, 0);
1da177e4
LT
1447}
1448
32ee8c3e 1449/**
4ab70df4 1450 * cpufreq_quick_get - get the CPU frequency (in kHz) from policy->cur
95235ca2
VP
1451 * @cpu: CPU number
1452 *
1453 * This is the last known freq, without actually getting it from the driver.
1454 * Return value will be same as what is shown in scaling_cur_freq in sysfs.
1455 */
1456unsigned int cpufreq_quick_get(unsigned int cpu)
1457{
9e21ba8b 1458 struct cpufreq_policy *policy;
e08f5f5b 1459 unsigned int ret_freq = 0;
c75361c0 1460 unsigned long flags;
95235ca2 1461
c75361c0
RC
1462 read_lock_irqsave(&cpufreq_driver_lock, flags);
1463
1464 if (cpufreq_driver && cpufreq_driver->setpolicy && cpufreq_driver->get) {
1465 ret_freq = cpufreq_driver->get(cpu);
1466 read_unlock_irqrestore(&cpufreq_driver_lock, flags);
1467 return ret_freq;
1468 }
1469
1470 read_unlock_irqrestore(&cpufreq_driver_lock, flags);
9e21ba8b
DB
1471
1472 policy = cpufreq_cpu_get(cpu);
95235ca2 1473 if (policy) {
e08f5f5b 1474 ret_freq = policy->cur;
95235ca2
VP
1475 cpufreq_cpu_put(policy);
1476 }
1477
4d34a67d 1478 return ret_freq;
95235ca2
VP
1479}
1480EXPORT_SYMBOL(cpufreq_quick_get);
1481
3d737108
JB
1482/**
1483 * cpufreq_quick_get_max - get the max reported CPU frequency for this CPU
1484 * @cpu: CPU number
1485 *
1486 * Just return the max possible frequency for a given CPU.
1487 */
1488unsigned int cpufreq_quick_get_max(unsigned int cpu)
1489{
1490 struct cpufreq_policy *policy = cpufreq_cpu_get(cpu);
1491 unsigned int ret_freq = 0;
1492
1493 if (policy) {
1494 ret_freq = policy->max;
1495 cpufreq_cpu_put(policy);
1496 }
1497
1498 return ret_freq;
1499}
1500EXPORT_SYMBOL(cpufreq_quick_get_max);
1501
d92d50a4 1502static unsigned int __cpufreq_get(struct cpufreq_policy *policy)
1da177e4 1503{
e08f5f5b 1504 unsigned int ret_freq = 0;
5800043b 1505
1c3d85dd 1506 if (!cpufreq_driver->get)
4d34a67d 1507 return ret_freq;
1da177e4 1508
d92d50a4 1509 ret_freq = cpufreq_driver->get(policy->cpu);
1da177e4 1510
b7898fda
RW
1511 /*
1512 * Updating inactive policies is invalid, so avoid doing that. Also
1513 * if fast frequency switching is used with the given policy, the check
1514 * against policy->cur is pointless, so skip it in that case too.
1515 */
1516 if (unlikely(policy_is_inactive(policy)) || policy->fast_switch_enabled)
11e584cf
VK
1517 return ret_freq;
1518
e08f5f5b 1519 if (ret_freq && policy->cur &&
1c3d85dd 1520 !(cpufreq_driver->flags & CPUFREQ_CONST_LOOPS)) {
e08f5f5b
GS
1521 /* verify no discrepancy between actual and
1522 saved value exists */
1523 if (unlikely(ret_freq != policy->cur)) {
a1e1dc41 1524 cpufreq_out_of_sync(policy, ret_freq);
1da177e4
LT
1525 schedule_work(&policy->update);
1526 }
1527 }
1528
4d34a67d 1529 return ret_freq;
5a01f2e8 1530}
1da177e4 1531
5a01f2e8
VP
1532/**
1533 * cpufreq_get - get the current CPU frequency (in kHz)
1534 * @cpu: CPU number
1535 *
1536 * Get the CPU current (static) CPU frequency
1537 */
1538unsigned int cpufreq_get(unsigned int cpu)
1539{
999976e0 1540 struct cpufreq_policy *policy = cpufreq_cpu_get(cpu);
5a01f2e8 1541 unsigned int ret_freq = 0;
5a01f2e8 1542
999976e0
AP
1543 if (policy) {
1544 down_read(&policy->rwsem);
d92d50a4 1545 ret_freq = __cpufreq_get(policy);
999976e0 1546 up_read(&policy->rwsem);
5a01f2e8 1547
999976e0
AP
1548 cpufreq_cpu_put(policy);
1549 }
6eed9404 1550
4d34a67d 1551 return ret_freq;
1da177e4
LT
1552}
1553EXPORT_SYMBOL(cpufreq_get);
1554
999f5729
RW
1555static unsigned int cpufreq_update_current_freq(struct cpufreq_policy *policy)
1556{
1557 unsigned int new_freq;
1558
c9d9c929
RW
1559 if (cpufreq_suspended)
1560 return 0;
1561
999f5729
RW
1562 new_freq = cpufreq_driver->get(policy->cpu);
1563 if (!new_freq)
1564 return 0;
1565
1566 if (!policy->cur) {
1567 pr_debug("cpufreq: Driver did not initialize current freq\n");
1568 policy->cur = new_freq;
1569 } else if (policy->cur != new_freq && has_target()) {
1570 cpufreq_out_of_sync(policy, new_freq);
1571 }
1572
1573 return new_freq;
1574}
1575
8a25a2fd
KS
1576static struct subsys_interface cpufreq_interface = {
1577 .name = "cpufreq",
1578 .subsys = &cpu_subsys,
1579 .add_dev = cpufreq_add_dev,
1580 .remove_dev = cpufreq_remove_dev,
e00e56df
RW
1581};
1582
e28867ea
VK
1583/*
1584 * In case platform wants some specific frequency to be configured
1585 * during suspend..
1586 */
1587int cpufreq_generic_suspend(struct cpufreq_policy *policy)
1588{
1589 int ret;
1590
1591 if (!policy->suspend_freq) {
201f3716
BZ
1592 pr_debug("%s: suspend_freq not defined\n", __func__);
1593 return 0;
e28867ea
VK
1594 }
1595
1596 pr_debug("%s: Setting suspend-freq: %u\n", __func__,
1597 policy->suspend_freq);
1598
1599 ret = __cpufreq_driver_target(policy, policy->suspend_freq,
1600 CPUFREQ_RELATION_H);
1601 if (ret)
1602 pr_err("%s: unable to set suspend-freq: %u. err: %d\n",
1603 __func__, policy->suspend_freq, ret);
1604
1605 return ret;
1606}
1607EXPORT_SYMBOL(cpufreq_generic_suspend);
1608
42d4dc3f 1609/**
2f0aea93 1610 * cpufreq_suspend() - Suspend CPUFreq governors
e00e56df 1611 *
2f0aea93
VK
1612 * Called during system wide Suspend/Hibernate cycles for suspending governors
1613 * as some platforms can't change frequency after this point in suspend cycle.
1614 * Because some of the devices (like: i2c, regulators, etc) they use for
1615 * changing frequency are suspended quickly after this point.
42d4dc3f 1616 */
2f0aea93 1617void cpufreq_suspend(void)
42d4dc3f 1618{
3a3e9e06 1619 struct cpufreq_policy *policy;
42d4dc3f 1620
2f0aea93
VK
1621 if (!cpufreq_driver)
1622 return;
42d4dc3f 1623
ba41e1bc 1624 if (!has_target() && !cpufreq_driver->suspend)
b1b12bab 1625 goto suspend;
42d4dc3f 1626
2f0aea93
VK
1627 pr_debug("%s: Suspending Governors\n", __func__);
1628
f963735a 1629 for_each_active_policy(policy) {
ba41e1bc
RW
1630 if (has_target()) {
1631 down_write(&policy->rwsem);
45482c70 1632 cpufreq_stop_governor(policy);
ba41e1bc 1633 up_write(&policy->rwsem);
ba41e1bc
RW
1634 }
1635
1636 if (cpufreq_driver->suspend && cpufreq_driver->suspend(policy))
2f0aea93
VK
1637 pr_err("%s: Failed to suspend driver: %p\n", __func__,
1638 policy);
42d4dc3f 1639 }
b1b12bab
VK
1640
1641suspend:
1642 cpufreq_suspended = true;
42d4dc3f
BH
1643}
1644
1da177e4 1645/**
2f0aea93 1646 * cpufreq_resume() - Resume CPUFreq governors
1da177e4 1647 *
2f0aea93
VK
1648 * Called during system wide Suspend/Hibernate cycle for resuming governors that
1649 * are suspended with cpufreq_suspend().
1da177e4 1650 */
2f0aea93 1651void cpufreq_resume(void)
1da177e4 1652{
3a3e9e06 1653 struct cpufreq_policy *policy;
49f18560 1654 int ret;
1da177e4 1655
2f0aea93
VK
1656 if (!cpufreq_driver)
1657 return;
1da177e4 1658
8e30444e
LT
1659 cpufreq_suspended = false;
1660
ba41e1bc 1661 if (!has_target() && !cpufreq_driver->resume)
e00e56df 1662 return;
1da177e4 1663
2f0aea93 1664 pr_debug("%s: Resuming Governors\n", __func__);
1da177e4 1665
f963735a 1666 for_each_active_policy(policy) {
49f18560 1667 if (cpufreq_driver->resume && cpufreq_driver->resume(policy)) {
0c5aa405
VK
1668 pr_err("%s: Failed to resume driver: %p\n", __func__,
1669 policy);
ba41e1bc 1670 } else if (has_target()) {
49f18560 1671 down_write(&policy->rwsem);
0a300767 1672 ret = cpufreq_start_governor(policy);
49f18560
VK
1673 up_write(&policy->rwsem);
1674
1675 if (ret)
1676 pr_err("%s: Failed to start governor for policy: %p\n",
1677 __func__, policy);
1678 }
2f0aea93
VK
1679 }
1680}
1da177e4 1681
9d95046e
BP
1682/**
1683 * cpufreq_get_current_driver - return current driver's name
1684 *
1685 * Return the name string of the currently loaded cpufreq driver
1686 * or NULL, if none.
1687 */
1688const char *cpufreq_get_current_driver(void)
1689{
1c3d85dd
RW
1690 if (cpufreq_driver)
1691 return cpufreq_driver->name;
1692
1693 return NULL;
9d95046e
BP
1694}
1695EXPORT_SYMBOL_GPL(cpufreq_get_current_driver);
1da177e4 1696
51315cdf
TP
1697/**
1698 * cpufreq_get_driver_data - return current driver data
1699 *
1700 * Return the private data of the currently loaded cpufreq
1701 * driver, or NULL if no cpufreq driver is loaded.
1702 */
1703void *cpufreq_get_driver_data(void)
1704{
1705 if (cpufreq_driver)
1706 return cpufreq_driver->driver_data;
1707
1708 return NULL;
1709}
1710EXPORT_SYMBOL_GPL(cpufreq_get_driver_data);
1711
1da177e4
LT
1712/*********************************************************************
1713 * NOTIFIER LISTS INTERFACE *
1714 *********************************************************************/
1715
1716/**
1717 * cpufreq_register_notifier - register a driver with cpufreq
1718 * @nb: notifier function to register
1719 * @list: CPUFREQ_TRANSITION_NOTIFIER or CPUFREQ_POLICY_NOTIFIER
1720 *
32ee8c3e 1721 * Add a driver to one of two lists: either a list of drivers that
1da177e4
LT
1722 * are notified about clock rate changes (once before and once after
1723 * the transition), or a list of drivers that are notified about
1724 * changes in cpufreq policy.
1725 *
1726 * This function may sleep, and has the same return conditions as
e041c683 1727 * blocking_notifier_chain_register.
1da177e4
LT
1728 */
1729int cpufreq_register_notifier(struct notifier_block *nb, unsigned int list)
1730{
1731 int ret;
1732
d5aaffa9
DB
1733 if (cpufreq_disabled())
1734 return -EINVAL;
1735
74212ca4
CEB
1736 WARN_ON(!init_cpufreq_transition_notifier_list_called);
1737
1da177e4
LT
1738 switch (list) {
1739 case CPUFREQ_TRANSITION_NOTIFIER:
b7898fda
RW
1740 mutex_lock(&cpufreq_fast_switch_lock);
1741
1742 if (cpufreq_fast_switch_count > 0) {
1743 mutex_unlock(&cpufreq_fast_switch_lock);
1744 return -EBUSY;
1745 }
b4dfdbb3 1746 ret = srcu_notifier_chain_register(
e041c683 1747 &cpufreq_transition_notifier_list, nb);
b7898fda
RW
1748 if (!ret)
1749 cpufreq_fast_switch_count--;
1750
1751 mutex_unlock(&cpufreq_fast_switch_lock);
1da177e4
LT
1752 break;
1753 case CPUFREQ_POLICY_NOTIFIER:
e041c683
AS
1754 ret = blocking_notifier_chain_register(
1755 &cpufreq_policy_notifier_list, nb);
1da177e4
LT
1756 break;
1757 default:
1758 ret = -EINVAL;
1759 }
1da177e4
LT
1760
1761 return ret;
1762}
1763EXPORT_SYMBOL(cpufreq_register_notifier);
1764
1da177e4
LT
1765/**
1766 * cpufreq_unregister_notifier - unregister a driver with cpufreq
1767 * @nb: notifier block to be unregistered
bb176f7d 1768 * @list: CPUFREQ_TRANSITION_NOTIFIER or CPUFREQ_POLICY_NOTIFIER
1da177e4
LT
1769 *
1770 * Remove a driver from the CPU frequency notifier list.
1771 *
1772 * This function may sleep, and has the same return conditions as
e041c683 1773 * blocking_notifier_chain_unregister.
1da177e4
LT
1774 */
1775int cpufreq_unregister_notifier(struct notifier_block *nb, unsigned int list)
1776{
1777 int ret;
1778
d5aaffa9
DB
1779 if (cpufreq_disabled())
1780 return -EINVAL;
1781
1da177e4
LT
1782 switch (list) {
1783 case CPUFREQ_TRANSITION_NOTIFIER:
b7898fda
RW
1784 mutex_lock(&cpufreq_fast_switch_lock);
1785
b4dfdbb3 1786 ret = srcu_notifier_chain_unregister(
e041c683 1787 &cpufreq_transition_notifier_list, nb);
b7898fda
RW
1788 if (!ret && !WARN_ON(cpufreq_fast_switch_count >= 0))
1789 cpufreq_fast_switch_count++;
1790
1791 mutex_unlock(&cpufreq_fast_switch_lock);
1da177e4
LT
1792 break;
1793 case CPUFREQ_POLICY_NOTIFIER:
e041c683
AS
1794 ret = blocking_notifier_chain_unregister(
1795 &cpufreq_policy_notifier_list, nb);
1da177e4
LT
1796 break;
1797 default:
1798 ret = -EINVAL;
1799 }
1da177e4
LT
1800
1801 return ret;
1802}
1803EXPORT_SYMBOL(cpufreq_unregister_notifier);
1804
1805
1806/*********************************************************************
1807 * GOVERNORS *
1808 *********************************************************************/
1809
b7898fda
RW
1810/**
1811 * cpufreq_driver_fast_switch - Carry out a fast CPU frequency switch.
1812 * @policy: cpufreq policy to switch the frequency for.
1813 * @target_freq: New frequency to set (may be approximate).
1814 *
1815 * Carry out a fast frequency switch without sleeping.
1816 *
1817 * The driver's ->fast_switch() callback invoked by this function must be
1818 * suitable for being called from within RCU-sched read-side critical sections
1819 * and it is expected to select the minimum available frequency greater than or
1820 * equal to @target_freq (CPUFREQ_RELATION_L).
1821 *
1822 * This function must not be called if policy->fast_switch_enabled is unset.
1823 *
1824 * Governors calling this function must guarantee that it will never be invoked
1825 * twice in parallel for the same policy and that it will never be called in
1826 * parallel with either ->target() or ->target_index() for the same policy.
1827 *
1828 * If CPUFREQ_ENTRY_INVALID is returned by the driver's ->fast_switch()
1829 * callback to indicate an error condition, the hardware configuration must be
1830 * preserved.
1831 */
1832unsigned int cpufreq_driver_fast_switch(struct cpufreq_policy *policy,
1833 unsigned int target_freq)
1834{
b9af6948 1835 target_freq = clamp_val(target_freq, policy->min, policy->max);
b7898fda
RW
1836
1837 return cpufreq_driver->fast_switch(policy, target_freq);
1838}
1839EXPORT_SYMBOL_GPL(cpufreq_driver_fast_switch);
1840
1c03a2d0
VK
1841/* Must set freqs->new to intermediate frequency */
1842static int __target_intermediate(struct cpufreq_policy *policy,
1843 struct cpufreq_freqs *freqs, int index)
1844{
1845 int ret;
1846
1847 freqs->new = cpufreq_driver->get_intermediate(policy, index);
1848
1849 /* We don't need to switch to intermediate freq */
1850 if (!freqs->new)
1851 return 0;
1852
1853 pr_debug("%s: cpu: %d, switching to intermediate freq: oldfreq: %u, intermediate freq: %u\n",
1854 __func__, policy->cpu, freqs->old, freqs->new);
1855
1856 cpufreq_freq_transition_begin(policy, freqs);
1857 ret = cpufreq_driver->target_intermediate(policy, index);
1858 cpufreq_freq_transition_end(policy, freqs, ret);
1859
1860 if (ret)
1861 pr_err("%s: Failed to change to intermediate frequency: %d\n",
1862 __func__, ret);
1863
1864 return ret;
1865}
1866
8d65775d
VK
1867static int __target_index(struct cpufreq_policy *policy,
1868 struct cpufreq_frequency_table *freq_table, int index)
1869{
1c03a2d0
VK
1870 struct cpufreq_freqs freqs = {.old = policy->cur, .flags = 0};
1871 unsigned int intermediate_freq = 0;
8d65775d
VK
1872 int retval = -EINVAL;
1873 bool notify;
1874
1875 notify = !(cpufreq_driver->flags & CPUFREQ_ASYNC_NOTIFICATION);
8d65775d 1876 if (notify) {
1c03a2d0
VK
1877 /* Handle switching to intermediate frequency */
1878 if (cpufreq_driver->get_intermediate) {
1879 retval = __target_intermediate(policy, &freqs, index);
1880 if (retval)
1881 return retval;
1882
1883 intermediate_freq = freqs.new;
1884 /* Set old freq to intermediate */
1885 if (intermediate_freq)
1886 freqs.old = freqs.new;
1887 }
8d65775d 1888
1c03a2d0 1889 freqs.new = freq_table[index].frequency;
8d65775d
VK
1890 pr_debug("%s: cpu: %d, oldfreq: %u, new freq: %u\n",
1891 __func__, policy->cpu, freqs.old, freqs.new);
1892
1893 cpufreq_freq_transition_begin(policy, &freqs);
1894 }
1895
1896 retval = cpufreq_driver->target_index(policy, index);
1897 if (retval)
1898 pr_err("%s: Failed to change cpu frequency: %d\n", __func__,
1899 retval);
1900
1c03a2d0 1901 if (notify) {
8d65775d
VK
1902 cpufreq_freq_transition_end(policy, &freqs, retval);
1903
1c03a2d0
VK
1904 /*
1905 * Failed after setting to intermediate freq? Driver should have
1906 * reverted back to initial frequency and so should we. Check
1907 * here for intermediate_freq instead of get_intermediate, in
58405af6 1908 * case we haven't switched to intermediate freq at all.
1c03a2d0
VK
1909 */
1910 if (unlikely(retval && intermediate_freq)) {
1911 freqs.old = intermediate_freq;
1912 freqs.new = policy->restore_freq;
1913 cpufreq_freq_transition_begin(policy, &freqs);
1914 cpufreq_freq_transition_end(policy, &freqs, 0);
1915 }
1916 }
1917
8d65775d
VK
1918 return retval;
1919}
1920
1da177e4
LT
1921int __cpufreq_driver_target(struct cpufreq_policy *policy,
1922 unsigned int target_freq,
1923 unsigned int relation)
1924{
7249924e 1925 unsigned int old_target_freq = target_freq;
6019d23a
RW
1926 struct cpufreq_frequency_table *freq_table;
1927 int index, retval;
c32b6b8e 1928
a7b422cd
KRW
1929 if (cpufreq_disabled())
1930 return -ENODEV;
1931
7249924e
VK
1932 /* Make sure that target_freq is within supported range */
1933 if (target_freq > policy->max)
1934 target_freq = policy->max;
1935 if (target_freq < policy->min)
1936 target_freq = policy->min;
1937
1938 pr_debug("target for CPU %u: %u kHz, relation %u, requested %u kHz\n",
e837f9b5 1939 policy->cpu, target_freq, relation, old_target_freq);
5a1c0228 1940
9c0ebcf7
VK
1941 /*
1942 * This might look like a redundant call as we are checking it again
1943 * after finding index. But it is left intentionally for cases where
1944 * exactly same freq is called again and so we can save on few function
1945 * calls.
1946 */
5a1c0228
VK
1947 if (target_freq == policy->cur)
1948 return 0;
1949
1c03a2d0
VK
1950 /* Save last value to restore later on errors */
1951 policy->restore_freq = policy->cur;
1952
1c3d85dd 1953 if (cpufreq_driver->target)
6019d23a 1954 return cpufreq_driver->target(policy, target_freq, relation);
9c0ebcf7 1955
6019d23a
RW
1956 if (!cpufreq_driver->target_index)
1957 return -EINVAL;
9c0ebcf7 1958
6019d23a
RW
1959 freq_table = cpufreq_frequency_get_table(policy->cpu);
1960 if (unlikely(!freq_table)) {
1961 pr_err("%s: Unable to find freq_table\n", __func__);
1962 return -EINVAL;
1963 }
d4019f0a 1964
6019d23a
RW
1965 retval = cpufreq_frequency_table_target(policy, freq_table, target_freq,
1966 relation, &index);
1967 if (unlikely(retval)) {
1968 pr_err("%s: Unable to find matching freq\n", __func__);
1969 return retval;
9c0ebcf7
VK
1970 }
1971
6019d23a
RW
1972 if (freq_table[index].frequency == policy->cur)
1973 return 0;
1974
1975 return __target_index(policy, freq_table, index);
1da177e4
LT
1976}
1977EXPORT_SYMBOL_GPL(__cpufreq_driver_target);
1978
1da177e4
LT
1979int cpufreq_driver_target(struct cpufreq_policy *policy,
1980 unsigned int target_freq,
1981 unsigned int relation)
1982{
f1829e4a 1983 int ret = -EINVAL;
1da177e4 1984
ad7722da 1985 down_write(&policy->rwsem);
1da177e4
LT
1986
1987 ret = __cpufreq_driver_target(policy, target_freq, relation);
1988
ad7722da 1989 up_write(&policy->rwsem);
1da177e4 1990
1da177e4
LT
1991 return ret;
1992}
1993EXPORT_SYMBOL_GPL(cpufreq_driver_target);
1994
de1df26b
RW
1995__weak struct cpufreq_governor *cpufreq_fallback_governor(void)
1996{
1997 return NULL;
1998}
1999
a1317e09 2000static int cpufreq_governor(struct cpufreq_policy *policy, unsigned int event)
1da177e4 2001{
cc993cab 2002 int ret;
6afde10c 2003
2f0aea93
VK
2004 /* Don't start any governor operations if we are entering suspend */
2005 if (cpufreq_suspended)
2006 return 0;
cb57720b
EZ
2007 /*
2008 * Governor might not be initiated here if ACPI _PPC changed
2009 * notification happened, so check it.
2010 */
2011 if (!policy->governor)
2012 return -EINVAL;
2f0aea93 2013
1c256245
TR
2014 if (policy->governor->max_transition_latency &&
2015 policy->cpuinfo.transition_latency >
2016 policy->governor->max_transition_latency) {
de1df26b
RW
2017 struct cpufreq_governor *gov = cpufreq_fallback_governor();
2018
2019 if (gov) {
e837f9b5
JP
2020 pr_warn("%s governor failed, too long transition latency of HW, fallback to %s governor\n",
2021 policy->governor->name, gov->name);
6afde10c 2022 policy->governor = gov;
de1df26b
RW
2023 } else {
2024 return -EINVAL;
6afde10c 2025 }
1c256245 2026 }
1da177e4 2027
fe492f3f
VK
2028 if (event == CPUFREQ_GOV_POLICY_INIT)
2029 if (!try_module_get(policy->governor->owner))
2030 return -EINVAL;
1da177e4 2031
63431f78 2032 pr_debug("%s: for CPU %u, event %u\n", __func__, policy->cpu, event);
95731ebb 2033
1da177e4
LT
2034 ret = policy->governor->governor(policy, event);
2035
36be3418
RW
2036 if (event == CPUFREQ_GOV_POLICY_INIT) {
2037 if (ret)
2038 module_put(policy->governor->owner);
2039 else
4d5dcc42 2040 policy->governor->initialized++;
36be3418
RW
2041 } else if (event == CPUFREQ_GOV_POLICY_EXIT) {
2042 policy->governor->initialized--;
1da177e4 2043 module_put(policy->governor->owner);
36be3418 2044 }
1da177e4
LT
2045
2046 return ret;
2047}
2048
0a300767
RW
2049static int cpufreq_start_governor(struct cpufreq_policy *policy)
2050{
2051 int ret;
2052
3bbf8fe3
RW
2053 if (cpufreq_driver->get && !cpufreq_driver->setpolicy)
2054 cpufreq_update_current_freq(policy);
2055
0a300767
RW
2056 ret = cpufreq_governor(policy, CPUFREQ_GOV_START);
2057 return ret ? ret : cpufreq_governor(policy, CPUFREQ_GOV_LIMITS);
2058}
2059
1da177e4
LT
2060int cpufreq_register_governor(struct cpufreq_governor *governor)
2061{
3bcb09a3 2062 int err;
1da177e4
LT
2063
2064 if (!governor)
2065 return -EINVAL;
2066
a7b422cd
KRW
2067 if (cpufreq_disabled())
2068 return -ENODEV;
2069
3fc54d37 2070 mutex_lock(&cpufreq_governor_mutex);
32ee8c3e 2071
b394058f 2072 governor->initialized = 0;
3bcb09a3 2073 err = -EBUSY;
42f91fa1 2074 if (!find_governor(governor->name)) {
3bcb09a3
JF
2075 err = 0;
2076 list_add(&governor->governor_list, &cpufreq_governor_list);
1da177e4 2077 }
1da177e4 2078
32ee8c3e 2079 mutex_unlock(&cpufreq_governor_mutex);
3bcb09a3 2080 return err;
1da177e4
LT
2081}
2082EXPORT_SYMBOL_GPL(cpufreq_register_governor);
2083
1da177e4
LT
2084void cpufreq_unregister_governor(struct cpufreq_governor *governor)
2085{
4573237b
VK
2086 struct cpufreq_policy *policy;
2087 unsigned long flags;
90e41bac 2088
1da177e4
LT
2089 if (!governor)
2090 return;
2091
a7b422cd
KRW
2092 if (cpufreq_disabled())
2093 return;
2094
4573237b
VK
2095 /* clear last_governor for all inactive policies */
2096 read_lock_irqsave(&cpufreq_driver_lock, flags);
2097 for_each_inactive_policy(policy) {
18bf3a12
VK
2098 if (!strcmp(policy->last_governor, governor->name)) {
2099 policy->governor = NULL;
4573237b 2100 strcpy(policy->last_governor, "\0");
18bf3a12 2101 }
90e41bac 2102 }
4573237b 2103 read_unlock_irqrestore(&cpufreq_driver_lock, flags);
90e41bac 2104
3fc54d37 2105 mutex_lock(&cpufreq_governor_mutex);
1da177e4 2106 list_del(&governor->governor_list);
3fc54d37 2107 mutex_unlock(&cpufreq_governor_mutex);
1da177e4
LT
2108 return;
2109}
2110EXPORT_SYMBOL_GPL(cpufreq_unregister_governor);
2111
2112
1da177e4
LT
2113/*********************************************************************
2114 * POLICY INTERFACE *
2115 *********************************************************************/
2116
2117/**
2118 * cpufreq_get_policy - get the current cpufreq_policy
29464f28
DJ
2119 * @policy: struct cpufreq_policy into which the current cpufreq_policy
2120 * is written
1da177e4
LT
2121 *
2122 * Reads the current cpufreq policy.
2123 */
2124int cpufreq_get_policy(struct cpufreq_policy *policy, unsigned int cpu)
2125{
2126 struct cpufreq_policy *cpu_policy;
2127 if (!policy)
2128 return -EINVAL;
2129
2130 cpu_policy = cpufreq_cpu_get(cpu);
2131 if (!cpu_policy)
2132 return -EINVAL;
2133
d5b73cd8 2134 memcpy(policy, cpu_policy, sizeof(*policy));
1da177e4
LT
2135
2136 cpufreq_cpu_put(cpu_policy);
1da177e4
LT
2137 return 0;
2138}
2139EXPORT_SYMBOL(cpufreq_get_policy);
2140
153d7f3f 2141/*
037ce839
VK
2142 * policy : current policy.
2143 * new_policy: policy to be set.
153d7f3f 2144 */
037ce839 2145static int cpufreq_set_policy(struct cpufreq_policy *policy,
3a3e9e06 2146 struct cpufreq_policy *new_policy)
1da177e4 2147{
d9a789c7
RW
2148 struct cpufreq_governor *old_gov;
2149 int ret;
1da177e4 2150
e837f9b5
JP
2151 pr_debug("setting new policy for CPU %u: %u - %u kHz\n",
2152 new_policy->cpu, new_policy->min, new_policy->max);
1da177e4 2153
d5b73cd8 2154 memcpy(&new_policy->cpuinfo, &policy->cpuinfo, sizeof(policy->cpuinfo));
1da177e4 2155
fba9573b
PX
2156 /*
2157 * This check works well when we store new min/max freq attributes,
2158 * because new_policy is a copy of policy with one field updated.
2159 */
2160 if (new_policy->min > new_policy->max)
d9a789c7 2161 return -EINVAL;
9c9a43ed 2162
1da177e4 2163 /* verify the cpu speed can be set within this limit */
3a3e9e06 2164 ret = cpufreq_driver->verify(new_policy);
1da177e4 2165 if (ret)
d9a789c7 2166 return ret;
1da177e4 2167
1da177e4 2168 /* adjust if necessary - all reasons */
e041c683 2169 blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
3a3e9e06 2170 CPUFREQ_ADJUST, new_policy);
1da177e4 2171
bb176f7d
VK
2172 /*
2173 * verify the cpu speed can be set within this limit, which might be
2174 * different to the first one
2175 */
3a3e9e06 2176 ret = cpufreq_driver->verify(new_policy);
e041c683 2177 if (ret)
d9a789c7 2178 return ret;
1da177e4
LT
2179
2180 /* notification of the new policy */
e041c683 2181 blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
3a3e9e06 2182 CPUFREQ_NOTIFY, new_policy);
1da177e4 2183
3a3e9e06
VK
2184 policy->min = new_policy->min;
2185 policy->max = new_policy->max;
1da177e4 2186
2d06d8c4 2187 pr_debug("new min and max freqs are %u - %u kHz\n",
e837f9b5 2188 policy->min, policy->max);
1da177e4 2189
1c3d85dd 2190 if (cpufreq_driver->setpolicy) {
3a3e9e06 2191 policy->policy = new_policy->policy;
2d06d8c4 2192 pr_debug("setting range\n");
d9a789c7
RW
2193 return cpufreq_driver->setpolicy(new_policy);
2194 }
1da177e4 2195
0a300767
RW
2196 if (new_policy->governor == policy->governor) {
2197 pr_debug("cpufreq: governor limits update\n");
2198 return cpufreq_governor(policy, CPUFREQ_GOV_LIMITS);
2199 }
7bd353a9 2200
d9a789c7
RW
2201 pr_debug("governor switch\n");
2202
2203 /* save old, working values */
2204 old_gov = policy->governor;
2205 /* end old governor */
2206 if (old_gov) {
45482c70 2207 cpufreq_stop_governor(policy);
36be3418 2208 cpufreq_exit_governor(policy);
1da177e4
LT
2209 }
2210
d9a789c7
RW
2211 /* start new governor */
2212 policy->governor = new_policy->governor;
a1317e09 2213 ret = cpufreq_governor(policy, CPUFREQ_GOV_POLICY_INIT);
4bc384ae 2214 if (!ret) {
0a300767
RW
2215 ret = cpufreq_start_governor(policy);
2216 if (!ret) {
2217 pr_debug("cpufreq: governor change\n");
2218 return 0;
2219 }
b7898fda 2220 cpufreq_exit_governor(policy);
d9a789c7
RW
2221 }
2222
2223 /* new governor failed, so re-start old one */
2224 pr_debug("starting governor %s failed\n", policy->governor->name);
2225 if (old_gov) {
2226 policy->governor = old_gov;
a1317e09 2227 if (cpufreq_governor(policy, CPUFREQ_GOV_POLICY_INIT))
4bc384ae
VK
2228 policy->governor = NULL;
2229 else
0a300767 2230 cpufreq_start_governor(policy);
d9a789c7
RW
2231 }
2232
4bc384ae 2233 return ret;
1da177e4
LT
2234}
2235
1da177e4
LT
2236/**
2237 * cpufreq_update_policy - re-evaluate an existing cpufreq policy
2238 * @cpu: CPU which shall be re-evaluated
2239 *
25985edc 2240 * Useful for policy notifiers which have different necessities
1da177e4
LT
2241 * at different times.
2242 */
2243int cpufreq_update_policy(unsigned int cpu)
2244{
3a3e9e06
VK
2245 struct cpufreq_policy *policy = cpufreq_cpu_get(cpu);
2246 struct cpufreq_policy new_policy;
f1829e4a 2247 int ret;
1da177e4 2248
fefa8ff8
AP
2249 if (!policy)
2250 return -ENODEV;
1da177e4 2251
ad7722da 2252 down_write(&policy->rwsem);
1da177e4 2253
2d06d8c4 2254 pr_debug("updating policy for CPU %u\n", cpu);
d5b73cd8 2255 memcpy(&new_policy, policy, sizeof(*policy));
3a3e9e06
VK
2256 new_policy.min = policy->user_policy.min;
2257 new_policy.max = policy->user_policy.max;
1da177e4 2258
bb176f7d
VK
2259 /*
2260 * BIOS might change freq behind our back
2261 * -> ask driver for current freq and notify governors about a change
2262 */
2ed99e39 2263 if (cpufreq_driver->get && !cpufreq_driver->setpolicy) {
742c87bf
RW
2264 if (cpufreq_suspended) {
2265 ret = -EAGAIN;
2266 goto unlock;
2267 }
999f5729 2268 new_policy.cur = cpufreq_update_current_freq(policy);
bd0fa9bb
VK
2269 if (WARN_ON(!new_policy.cur)) {
2270 ret = -EIO;
fefa8ff8 2271 goto unlock;
bd0fa9bb 2272 }
0961dd0d
TR
2273 }
2274
037ce839 2275 ret = cpufreq_set_policy(policy, &new_policy);
1da177e4 2276
fefa8ff8 2277unlock:
ad7722da 2278 up_write(&policy->rwsem);
5a01f2e8 2279
3a3e9e06 2280 cpufreq_cpu_put(policy);
1da177e4
LT
2281 return ret;
2282}
2283EXPORT_SYMBOL(cpufreq_update_policy);
2284
2760984f 2285static int cpufreq_cpu_callback(struct notifier_block *nfb,
c32b6b8e
AR
2286 unsigned long action, void *hcpu)
2287{
2288 unsigned int cpu = (unsigned long)hcpu;
c32b6b8e 2289
0b275352
RW
2290 switch (action & ~CPU_TASKS_FROZEN) {
2291 case CPU_ONLINE:
cd73e9b0 2292 case CPU_DOWN_FAILED:
0b275352
RW
2293 cpufreq_online(cpu);
2294 break;
5302c3fb 2295
0b275352 2296 case CPU_DOWN_PREPARE:
69cee714 2297 cpufreq_offline(cpu);
0b275352 2298 break;
c32b6b8e
AR
2299 }
2300 return NOTIFY_OK;
2301}
2302
9c36f746 2303static struct notifier_block __refdata cpufreq_cpu_notifier = {
bb176f7d 2304 .notifier_call = cpufreq_cpu_callback,
c32b6b8e 2305};
1da177e4 2306
6f19efc0
LM
2307/*********************************************************************
2308 * BOOST *
2309 *********************************************************************/
2310static int cpufreq_boost_set_sw(int state)
2311{
2312 struct cpufreq_frequency_table *freq_table;
2313 struct cpufreq_policy *policy;
2314 int ret = -EINVAL;
2315
f963735a 2316 for_each_active_policy(policy) {
6f19efc0
LM
2317 freq_table = cpufreq_frequency_get_table(policy->cpu);
2318 if (freq_table) {
2319 ret = cpufreq_frequency_table_cpuinfo(policy,
2320 freq_table);
2321 if (ret) {
2322 pr_err("%s: Policy frequency update failed\n",
2323 __func__);
2324 break;
2325 }
49f18560
VK
2326
2327 down_write(&policy->rwsem);
6f19efc0 2328 policy->user_policy.max = policy->max;
a1317e09 2329 cpufreq_governor(policy, CPUFREQ_GOV_LIMITS);
49f18560 2330 up_write(&policy->rwsem);
6f19efc0
LM
2331 }
2332 }
2333
2334 return ret;
2335}
2336
2337int cpufreq_boost_trigger_state(int state)
2338{
2339 unsigned long flags;
2340 int ret = 0;
2341
2342 if (cpufreq_driver->boost_enabled == state)
2343 return 0;
2344
2345 write_lock_irqsave(&cpufreq_driver_lock, flags);
2346 cpufreq_driver->boost_enabled = state;
2347 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
2348
2349 ret = cpufreq_driver->set_boost(state);
2350 if (ret) {
2351 write_lock_irqsave(&cpufreq_driver_lock, flags);
2352 cpufreq_driver->boost_enabled = !state;
2353 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
2354
e837f9b5
JP
2355 pr_err("%s: Cannot %s BOOST\n",
2356 __func__, state ? "enable" : "disable");
6f19efc0
LM
2357 }
2358
2359 return ret;
2360}
2361
41669da0 2362static bool cpufreq_boost_supported(void)
6f19efc0 2363{
7a6c79f2 2364 return likely(cpufreq_driver) && cpufreq_driver->set_boost;
6f19efc0 2365}
6f19efc0 2366
44139ed4
VK
2367static int create_boost_sysfs_file(void)
2368{
2369 int ret;
2370
c82bd444 2371 ret = sysfs_create_file(cpufreq_global_kobject, &boost.attr);
44139ed4
VK
2372 if (ret)
2373 pr_err("%s: cannot register global BOOST sysfs file\n",
2374 __func__);
2375
2376 return ret;
2377}
2378
2379static void remove_boost_sysfs_file(void)
2380{
2381 if (cpufreq_boost_supported())
c82bd444 2382 sysfs_remove_file(cpufreq_global_kobject, &boost.attr);
44139ed4
VK
2383}
2384
2385int cpufreq_enable_boost_support(void)
2386{
2387 if (!cpufreq_driver)
2388 return -EINVAL;
2389
2390 if (cpufreq_boost_supported())
2391 return 0;
2392
7a6c79f2 2393 cpufreq_driver->set_boost = cpufreq_boost_set_sw;
44139ed4
VK
2394
2395 /* This will get removed on driver unregister */
2396 return create_boost_sysfs_file();
2397}
2398EXPORT_SYMBOL_GPL(cpufreq_enable_boost_support);
2399
6f19efc0
LM
2400int cpufreq_boost_enabled(void)
2401{
2402 return cpufreq_driver->boost_enabled;
2403}
2404EXPORT_SYMBOL_GPL(cpufreq_boost_enabled);
2405
1da177e4
LT
2406/*********************************************************************
2407 * REGISTER / UNREGISTER CPUFREQ DRIVER *
2408 *********************************************************************/
2409
2410/**
2411 * cpufreq_register_driver - register a CPU Frequency driver
2412 * @driver_data: A struct cpufreq_driver containing the values#
2413 * submitted by the CPU Frequency driver.
2414 *
bb176f7d 2415 * Registers a CPU Frequency driver to this core code. This code
63af4055 2416 * returns zero on success, -EEXIST when another driver got here first
32ee8c3e 2417 * (and isn't unregistered in the meantime).
1da177e4
LT
2418 *
2419 */
221dee28 2420int cpufreq_register_driver(struct cpufreq_driver *driver_data)
1da177e4
LT
2421{
2422 unsigned long flags;
2423 int ret;
2424
a7b422cd
KRW
2425 if (cpufreq_disabled())
2426 return -ENODEV;
2427
1da177e4 2428 if (!driver_data || !driver_data->verify || !driver_data->init ||
9c0ebcf7 2429 !(driver_data->setpolicy || driver_data->target_index ||
9832235f
RW
2430 driver_data->target) ||
2431 (driver_data->setpolicy && (driver_data->target_index ||
1c03a2d0
VK
2432 driver_data->target)) ||
2433 (!!driver_data->get_intermediate != !!driver_data->target_intermediate))
1da177e4
LT
2434 return -EINVAL;
2435
2d06d8c4 2436 pr_debug("trying to register driver %s\n", driver_data->name);
1da177e4 2437
fdd320da
RW
2438 /* Protect against concurrent CPU online/offline. */
2439 get_online_cpus();
2440
0d1857a1 2441 write_lock_irqsave(&cpufreq_driver_lock, flags);
1c3d85dd 2442 if (cpufreq_driver) {
0d1857a1 2443 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
fdd320da
RW
2444 ret = -EEXIST;
2445 goto out;
1da177e4 2446 }
1c3d85dd 2447 cpufreq_driver = driver_data;
0d1857a1 2448 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
1da177e4 2449
bc68b7df
VK
2450 if (driver_data->setpolicy)
2451 driver_data->flags |= CPUFREQ_CONST_LOOPS;
2452
7a6c79f2
RW
2453 if (cpufreq_boost_supported()) {
2454 ret = create_boost_sysfs_file();
2455 if (ret)
2456 goto err_null_driver;
2457 }
6f19efc0 2458
8a25a2fd 2459 ret = subsys_interface_register(&cpufreq_interface);
8f5bc2ab 2460 if (ret)
6f19efc0 2461 goto err_boost_unreg;
1da177e4 2462
ce1bcfe9
VK
2463 if (!(cpufreq_driver->flags & CPUFREQ_STICKY) &&
2464 list_empty(&cpufreq_policy_list)) {
1da177e4 2465 /* if all ->init() calls failed, unregister */
ce1bcfe9
VK
2466 pr_debug("%s: No CPU initialized for driver %s\n", __func__,
2467 driver_data->name);
2468 goto err_if_unreg;
1da177e4
LT
2469 }
2470
8f5bc2ab 2471 register_hotcpu_notifier(&cpufreq_cpu_notifier);
2d06d8c4 2472 pr_debug("driver %s up and running\n", driver_data->name);
3834abb4 2473 goto out;
fdd320da 2474
8a25a2fd
KS
2475err_if_unreg:
2476 subsys_interface_unregister(&cpufreq_interface);
6f19efc0 2477err_boost_unreg:
44139ed4 2478 remove_boost_sysfs_file();
8f5bc2ab 2479err_null_driver:
0d1857a1 2480 write_lock_irqsave(&cpufreq_driver_lock, flags);
1c3d85dd 2481 cpufreq_driver = NULL;
0d1857a1 2482 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
3834abb4
PG
2483out:
2484 put_online_cpus();
2485 return ret;
1da177e4
LT
2486}
2487EXPORT_SYMBOL_GPL(cpufreq_register_driver);
2488
1da177e4
LT
2489/**
2490 * cpufreq_unregister_driver - unregister the current CPUFreq driver
2491 *
bb176f7d 2492 * Unregister the current CPUFreq driver. Only call this if you have
1da177e4
LT
2493 * the right to do so, i.e. if you have succeeded in initialising before!
2494 * Returns zero if successful, and -EINVAL if the cpufreq_driver is
2495 * currently not initialised.
2496 */
221dee28 2497int cpufreq_unregister_driver(struct cpufreq_driver *driver)
1da177e4
LT
2498{
2499 unsigned long flags;
2500
1c3d85dd 2501 if (!cpufreq_driver || (driver != cpufreq_driver))
1da177e4 2502 return -EINVAL;
1da177e4 2503
2d06d8c4 2504 pr_debug("unregistering driver %s\n", driver->name);
1da177e4 2505
454d3a25
SAS
2506 /* Protect against concurrent cpu hotplug */
2507 get_online_cpus();
8a25a2fd 2508 subsys_interface_unregister(&cpufreq_interface);
44139ed4 2509 remove_boost_sysfs_file();
65edc68c 2510 unregister_hotcpu_notifier(&cpufreq_cpu_notifier);
1da177e4 2511
0d1857a1 2512 write_lock_irqsave(&cpufreq_driver_lock, flags);
6eed9404 2513
1c3d85dd 2514 cpufreq_driver = NULL;
6eed9404 2515
0d1857a1 2516 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
454d3a25 2517 put_online_cpus();
1da177e4
LT
2518
2519 return 0;
2520}
2521EXPORT_SYMBOL_GPL(cpufreq_unregister_driver);
5a01f2e8 2522
90de2a4a
DA
2523/*
2524 * Stop cpufreq at shutdown to make sure it isn't holding any locks
2525 * or mutexes when secondary CPUs are halted.
2526 */
2527static struct syscore_ops cpufreq_syscore_ops = {
2528 .shutdown = cpufreq_suspend,
2529};
2530
c82bd444
VK
2531struct kobject *cpufreq_global_kobject;
2532EXPORT_SYMBOL(cpufreq_global_kobject);
2533
5a01f2e8
VP
2534static int __init cpufreq_core_init(void)
2535{
a7b422cd
KRW
2536 if (cpufreq_disabled())
2537 return -ENODEV;
2538
8eec1020 2539 cpufreq_global_kobject = kobject_create_and_add("cpufreq", &cpu_subsys.dev_root->kobj);
8aa84ad8
TR
2540 BUG_ON(!cpufreq_global_kobject);
2541
90de2a4a
DA
2542 register_syscore_ops(&cpufreq_syscore_ops);
2543
5a01f2e8
VP
2544 return 0;
2545}
5a01f2e8 2546core_initcall(cpufreq_core_init);