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