Merge back earlier 'pm-cpufreq' material.
[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 1325 if (cpu != policy->cpu) {
6964d91d 1326 sysfs_remove_link(&dev->kobj, "cpufreq");
73bf0fc2 1327 } else if (cpus > 1) {
42f921a6 1328 new_cpu = cpufreq_nominate_new_policy_cpu(policy, cpu);
f9ba680d 1329 if (new_cpu >= 0) {
3a3e9e06 1330 update_policy_cpu(policy, new_cpu);
a82fab29
SB
1331
1332 if (!frozen) {
75949c9a
VK
1333 pr_debug("%s: policy Kobject moved to cpu: %d from: %d\n",
1334 __func__, new_cpu, cpu);
a82fab29 1335 }
1da177e4
LT
1336 }
1337 }
1da177e4 1338
cedb70af
SB
1339 return 0;
1340}
1341
1342static int __cpufreq_remove_dev_finish(struct device *dev,
1343 struct subsys_interface *sif,
1344 bool frozen)
1345{
1346 unsigned int cpu = dev->id, cpus;
1347 int ret;
1348 unsigned long flags;
1349 struct cpufreq_policy *policy;
cedb70af
SB
1350
1351 read_lock_irqsave(&cpufreq_driver_lock, flags);
1352 policy = per_cpu(cpufreq_cpu_data, cpu);
1353 read_unlock_irqrestore(&cpufreq_driver_lock, flags);
1354
1355 if (!policy) {
1356 pr_debug("%s: No cpu_data found\n", __func__);
1357 return -EINVAL;
1358 }
1359
ad7722da 1360 down_write(&policy->rwsem);
cedb70af 1361 cpus = cpumask_weight(policy->cpus);
9c8f1ee4
VK
1362
1363 if (cpus > 1)
1364 cpumask_clear_cpu(cpu, policy->cpus);
ad7722da 1365 up_write(&policy->rwsem);
cedb70af 1366
b8eed8af
VK
1367 /* If cpu is last user of policy, free policy */
1368 if (cpus == 1) {
9c0ebcf7 1369 if (has_target()) {
3de9bdeb
VK
1370 ret = __cpufreq_governor(policy,
1371 CPUFREQ_GOV_POLICY_EXIT);
1372 if (ret) {
1373 pr_err("%s: Failed to exit governor\n",
1374 __func__);
1375 return ret;
1376 }
edab2fbc 1377 }
2a998599 1378
42f921a6
VK
1379 if (!frozen)
1380 cpufreq_policy_put_kobj(policy);
7d26e2d5 1381
8414809c
SB
1382 /*
1383 * Perform the ->exit() even during light-weight tear-down,
1384 * since this is a core component, and is essential for the
1385 * subsequent light-weight ->init() to succeed.
b8eed8af 1386 */
1c3d85dd 1387 if (cpufreq_driver->exit)
3a3e9e06 1388 cpufreq_driver->exit(policy);
27ecddc2 1389
9515f4d6
VK
1390 /* Remove policy from list of active policies */
1391 write_lock_irqsave(&cpufreq_driver_lock, flags);
1392 list_del(&policy->policy_list);
1393 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
1394
8414809c 1395 if (!frozen)
3a3e9e06 1396 cpufreq_policy_free(policy);
2a998599 1397 } else {
9c0ebcf7 1398 if (has_target()) {
3de9bdeb
VK
1399 if ((ret = __cpufreq_governor(policy, CPUFREQ_GOV_START)) ||
1400 (ret = __cpufreq_governor(policy, CPUFREQ_GOV_LIMITS))) {
1401 pr_err("%s: Failed to start governor\n",
1402 __func__);
1403 return ret;
1404 }
2a998599 1405 }
27ecddc2 1406 }
1da177e4 1407
474deff7 1408 per_cpu(cpufreq_cpu_data, cpu) = NULL;
1da177e4
LT
1409 return 0;
1410}
1411
cedb70af 1412/**
27a862e9 1413 * cpufreq_remove_dev - remove a CPU device
cedb70af
SB
1414 *
1415 * Removes the cpufreq interface for a CPU device.
cedb70af 1416 */
8a25a2fd 1417static int cpufreq_remove_dev(struct device *dev, struct subsys_interface *sif)
5a01f2e8 1418{
8a25a2fd 1419 unsigned int cpu = dev->id;
27a862e9 1420 int ret;
ec28297a
VP
1421
1422 if (cpu_is_offline(cpu))
1423 return 0;
1424
27a862e9
VK
1425 ret = __cpufreq_remove_dev_prepare(dev, sif, false);
1426
1427 if (!ret)
1428 ret = __cpufreq_remove_dev_finish(dev, sif, false);
1429
1430 return ret;
5a01f2e8
VP
1431}
1432
65f27f38 1433static void handle_update(struct work_struct *work)
1da177e4 1434{
65f27f38
DH
1435 struct cpufreq_policy *policy =
1436 container_of(work, struct cpufreq_policy, update);
1437 unsigned int cpu = policy->cpu;
2d06d8c4 1438 pr_debug("handle_update for cpu %u called\n", cpu);
1da177e4
LT
1439 cpufreq_update_policy(cpu);
1440}
1441
1442/**
bb176f7d
VK
1443 * cpufreq_out_of_sync - If actual and saved CPU frequency differs, we're
1444 * in deep trouble.
1da177e4
LT
1445 * @cpu: cpu number
1446 * @old_freq: CPU frequency the kernel thinks the CPU runs at
1447 * @new_freq: CPU frequency the CPU actually runs at
1448 *
29464f28
DJ
1449 * We adjust to current frequency first, and need to clean up later.
1450 * So either call to cpufreq_update_policy() or schedule handle_update()).
1da177e4 1451 */
e08f5f5b
GS
1452static void cpufreq_out_of_sync(unsigned int cpu, unsigned int old_freq,
1453 unsigned int new_freq)
1da177e4 1454{
b43a7ffb 1455 struct cpufreq_policy *policy;
1da177e4 1456 struct cpufreq_freqs freqs;
b43a7ffb
VK
1457 unsigned long flags;
1458
2d06d8c4 1459 pr_debug("Warning: CPU frequency out of sync: cpufreq and timing "
1da177e4
LT
1460 "core thinks of %u, is %u kHz.\n", old_freq, new_freq);
1461
1da177e4
LT
1462 freqs.old = old_freq;
1463 freqs.new = new_freq;
b43a7ffb
VK
1464
1465 read_lock_irqsave(&cpufreq_driver_lock, flags);
1466 policy = per_cpu(cpufreq_cpu_data, cpu);
1467 read_unlock_irqrestore(&cpufreq_driver_lock, flags);
1468
1469 cpufreq_notify_transition(policy, &freqs, CPUFREQ_PRECHANGE);
1470 cpufreq_notify_transition(policy, &freqs, CPUFREQ_POSTCHANGE);
1da177e4
LT
1471}
1472
32ee8c3e 1473/**
4ab70df4 1474 * cpufreq_quick_get - get the CPU frequency (in kHz) from policy->cur
95235ca2
VP
1475 * @cpu: CPU number
1476 *
1477 * This is the last known freq, without actually getting it from the driver.
1478 * Return value will be same as what is shown in scaling_cur_freq in sysfs.
1479 */
1480unsigned int cpufreq_quick_get(unsigned int cpu)
1481{
9e21ba8b 1482 struct cpufreq_policy *policy;
e08f5f5b 1483 unsigned int ret_freq = 0;
95235ca2 1484
1c3d85dd
RW
1485 if (cpufreq_driver && cpufreq_driver->setpolicy && cpufreq_driver->get)
1486 return cpufreq_driver->get(cpu);
9e21ba8b
DB
1487
1488 policy = cpufreq_cpu_get(cpu);
95235ca2 1489 if (policy) {
e08f5f5b 1490 ret_freq = policy->cur;
95235ca2
VP
1491 cpufreq_cpu_put(policy);
1492 }
1493
4d34a67d 1494 return ret_freq;
95235ca2
VP
1495}
1496EXPORT_SYMBOL(cpufreq_quick_get);
1497
3d737108
JB
1498/**
1499 * cpufreq_quick_get_max - get the max reported CPU frequency for this CPU
1500 * @cpu: CPU number
1501 *
1502 * Just return the max possible frequency for a given CPU.
1503 */
1504unsigned int cpufreq_quick_get_max(unsigned int cpu)
1505{
1506 struct cpufreq_policy *policy = cpufreq_cpu_get(cpu);
1507 unsigned int ret_freq = 0;
1508
1509 if (policy) {
1510 ret_freq = policy->max;
1511 cpufreq_cpu_put(policy);
1512 }
1513
1514 return ret_freq;
1515}
1516EXPORT_SYMBOL(cpufreq_quick_get_max);
1517
5a01f2e8 1518static unsigned int __cpufreq_get(unsigned int cpu)
1da177e4 1519{
7a6aedfa 1520 struct cpufreq_policy *policy = per_cpu(cpufreq_cpu_data, cpu);
e08f5f5b 1521 unsigned int ret_freq = 0;
5800043b 1522
1c3d85dd 1523 if (!cpufreq_driver->get)
4d34a67d 1524 return ret_freq;
1da177e4 1525
1c3d85dd 1526 ret_freq = cpufreq_driver->get(cpu);
1da177e4 1527
e08f5f5b 1528 if (ret_freq && policy->cur &&
1c3d85dd 1529 !(cpufreq_driver->flags & CPUFREQ_CONST_LOOPS)) {
e08f5f5b
GS
1530 /* verify no discrepancy between actual and
1531 saved value exists */
1532 if (unlikely(ret_freq != policy->cur)) {
1533 cpufreq_out_of_sync(cpu, policy->cur, ret_freq);
1da177e4
LT
1534 schedule_work(&policy->update);
1535 }
1536 }
1537
4d34a67d 1538 return ret_freq;
5a01f2e8 1539}
1da177e4 1540
5a01f2e8
VP
1541/**
1542 * cpufreq_get - get the current CPU frequency (in kHz)
1543 * @cpu: CPU number
1544 *
1545 * Get the CPU current (static) CPU frequency
1546 */
1547unsigned int cpufreq_get(unsigned int cpu)
1548{
ad7722da 1549 struct cpufreq_policy *policy = per_cpu(cpufreq_cpu_data, cpu);
5a01f2e8 1550 unsigned int ret_freq = 0;
5a01f2e8 1551
26ca8694
VK
1552 if (cpufreq_disabled() || !cpufreq_driver)
1553 return -ENOENT;
1554
ad7722da 1555 BUG_ON(!policy);
1556
6eed9404
VK
1557 if (!down_read_trylock(&cpufreq_rwsem))
1558 return 0;
5a01f2e8 1559
ad7722da 1560 down_read(&policy->rwsem);
5a01f2e8
VP
1561
1562 ret_freq = __cpufreq_get(cpu);
1563
ad7722da 1564 up_read(&policy->rwsem);
6eed9404
VK
1565 up_read(&cpufreq_rwsem);
1566
4d34a67d 1567 return ret_freq;
1da177e4
LT
1568}
1569EXPORT_SYMBOL(cpufreq_get);
1570
8a25a2fd
KS
1571static struct subsys_interface cpufreq_interface = {
1572 .name = "cpufreq",
1573 .subsys = &cpu_subsys,
1574 .add_dev = cpufreq_add_dev,
1575 .remove_dev = cpufreq_remove_dev,
e00e56df
RW
1576};
1577
42d4dc3f 1578/**
e00e56df
RW
1579 * cpufreq_bp_suspend - Prepare the boot CPU for system suspend.
1580 *
1581 * This function is only executed for the boot processor. The other CPUs
1582 * have been put offline by means of CPU hotplug.
42d4dc3f 1583 */
e00e56df 1584static int cpufreq_bp_suspend(void)
42d4dc3f 1585{
e08f5f5b 1586 int ret = 0;
4bc5d341 1587
e00e56df 1588 int cpu = smp_processor_id();
3a3e9e06 1589 struct cpufreq_policy *policy;
42d4dc3f 1590
2d06d8c4 1591 pr_debug("suspending cpu %u\n", cpu);
42d4dc3f 1592
e00e56df 1593 /* If there's no policy for the boot CPU, we have nothing to do. */
3a3e9e06
VK
1594 policy = cpufreq_cpu_get(cpu);
1595 if (!policy)
e00e56df 1596 return 0;
42d4dc3f 1597
1c3d85dd 1598 if (cpufreq_driver->suspend) {
3a3e9e06 1599 ret = cpufreq_driver->suspend(policy);
ce6c3997 1600 if (ret)
42d4dc3f 1601 printk(KERN_ERR "cpufreq: suspend failed in ->suspend "
3a3e9e06 1602 "step on CPU %u\n", policy->cpu);
42d4dc3f
BH
1603 }
1604
3a3e9e06 1605 cpufreq_cpu_put(policy);
c9060494 1606 return ret;
42d4dc3f
BH
1607}
1608
1da177e4 1609/**
e00e56df 1610 * cpufreq_bp_resume - Restore proper frequency handling of the boot CPU.
1da177e4
LT
1611 *
1612 * 1.) resume CPUfreq hardware support (cpufreq_driver->resume())
ce6c3997
DB
1613 * 2.) schedule call cpufreq_update_policy() ASAP as interrupts are
1614 * restored. It will verify that the current freq is in sync with
1615 * what we believe it to be. This is a bit later than when it
1616 * should be, but nonethteless it's better than calling
1617 * cpufreq_driver->get() here which might re-enable interrupts...
e00e56df
RW
1618 *
1619 * This function is only executed for the boot CPU. The other CPUs have not
1620 * been turned on yet.
1da177e4 1621 */
e00e56df 1622static void cpufreq_bp_resume(void)
1da177e4 1623{
e08f5f5b 1624 int ret = 0;
4bc5d341 1625
e00e56df 1626 int cpu = smp_processor_id();
3a3e9e06 1627 struct cpufreq_policy *policy;
1da177e4 1628
2d06d8c4 1629 pr_debug("resuming cpu %u\n", cpu);
1da177e4 1630
e00e56df 1631 /* If there's no policy for the boot CPU, we have nothing to do. */
3a3e9e06
VK
1632 policy = cpufreq_cpu_get(cpu);
1633 if (!policy)
e00e56df 1634 return;
1da177e4 1635
1c3d85dd 1636 if (cpufreq_driver->resume) {
3a3e9e06 1637 ret = cpufreq_driver->resume(policy);
1da177e4
LT
1638 if (ret) {
1639 printk(KERN_ERR "cpufreq: resume failed in ->resume "
3a3e9e06 1640 "step on CPU %u\n", policy->cpu);
c9060494 1641 goto fail;
1da177e4
LT
1642 }
1643 }
1644
3a3e9e06 1645 schedule_work(&policy->update);
ce6c3997 1646
c9060494 1647fail:
3a3e9e06 1648 cpufreq_cpu_put(policy);
1da177e4
LT
1649}
1650
e00e56df
RW
1651static struct syscore_ops cpufreq_syscore_ops = {
1652 .suspend = cpufreq_bp_suspend,
1653 .resume = cpufreq_bp_resume,
1da177e4
LT
1654};
1655
9d95046e
BP
1656/**
1657 * cpufreq_get_current_driver - return current driver's name
1658 *
1659 * Return the name string of the currently loaded cpufreq driver
1660 * or NULL, if none.
1661 */
1662const char *cpufreq_get_current_driver(void)
1663{
1c3d85dd
RW
1664 if (cpufreq_driver)
1665 return cpufreq_driver->name;
1666
1667 return NULL;
9d95046e
BP
1668}
1669EXPORT_SYMBOL_GPL(cpufreq_get_current_driver);
1da177e4
LT
1670
1671/*********************************************************************
1672 * NOTIFIER LISTS INTERFACE *
1673 *********************************************************************/
1674
1675/**
1676 * cpufreq_register_notifier - register a driver with cpufreq
1677 * @nb: notifier function to register
1678 * @list: CPUFREQ_TRANSITION_NOTIFIER or CPUFREQ_POLICY_NOTIFIER
1679 *
32ee8c3e 1680 * Add a driver to one of two lists: either a list of drivers that
1da177e4
LT
1681 * are notified about clock rate changes (once before and once after
1682 * the transition), or a list of drivers that are notified about
1683 * changes in cpufreq policy.
1684 *
1685 * This function may sleep, and has the same return conditions as
e041c683 1686 * blocking_notifier_chain_register.
1da177e4
LT
1687 */
1688int cpufreq_register_notifier(struct notifier_block *nb, unsigned int list)
1689{
1690 int ret;
1691
d5aaffa9
DB
1692 if (cpufreq_disabled())
1693 return -EINVAL;
1694
74212ca4
CEB
1695 WARN_ON(!init_cpufreq_transition_notifier_list_called);
1696
1da177e4
LT
1697 switch (list) {
1698 case CPUFREQ_TRANSITION_NOTIFIER:
b4dfdbb3 1699 ret = srcu_notifier_chain_register(
e041c683 1700 &cpufreq_transition_notifier_list, nb);
1da177e4
LT
1701 break;
1702 case CPUFREQ_POLICY_NOTIFIER:
e041c683
AS
1703 ret = blocking_notifier_chain_register(
1704 &cpufreq_policy_notifier_list, nb);
1da177e4
LT
1705 break;
1706 default:
1707 ret = -EINVAL;
1708 }
1da177e4
LT
1709
1710 return ret;
1711}
1712EXPORT_SYMBOL(cpufreq_register_notifier);
1713
1da177e4
LT
1714/**
1715 * cpufreq_unregister_notifier - unregister a driver with cpufreq
1716 * @nb: notifier block to be unregistered
bb176f7d 1717 * @list: CPUFREQ_TRANSITION_NOTIFIER or CPUFREQ_POLICY_NOTIFIER
1da177e4
LT
1718 *
1719 * Remove a driver from the CPU frequency notifier list.
1720 *
1721 * This function may sleep, and has the same return conditions as
e041c683 1722 * blocking_notifier_chain_unregister.
1da177e4
LT
1723 */
1724int cpufreq_unregister_notifier(struct notifier_block *nb, unsigned int list)
1725{
1726 int ret;
1727
d5aaffa9
DB
1728 if (cpufreq_disabled())
1729 return -EINVAL;
1730
1da177e4
LT
1731 switch (list) {
1732 case CPUFREQ_TRANSITION_NOTIFIER:
b4dfdbb3 1733 ret = srcu_notifier_chain_unregister(
e041c683 1734 &cpufreq_transition_notifier_list, nb);
1da177e4
LT
1735 break;
1736 case CPUFREQ_POLICY_NOTIFIER:
e041c683
AS
1737 ret = blocking_notifier_chain_unregister(
1738 &cpufreq_policy_notifier_list, nb);
1da177e4
LT
1739 break;
1740 default:
1741 ret = -EINVAL;
1742 }
1da177e4
LT
1743
1744 return ret;
1745}
1746EXPORT_SYMBOL(cpufreq_unregister_notifier);
1747
1748
1749/*********************************************************************
1750 * GOVERNORS *
1751 *********************************************************************/
1752
1da177e4
LT
1753int __cpufreq_driver_target(struct cpufreq_policy *policy,
1754 unsigned int target_freq,
1755 unsigned int relation)
1756{
1757 int retval = -EINVAL;
7249924e 1758 unsigned int old_target_freq = target_freq;
c32b6b8e 1759
a7b422cd
KRW
1760 if (cpufreq_disabled())
1761 return -ENODEV;
1762
7249924e
VK
1763 /* Make sure that target_freq is within supported range */
1764 if (target_freq > policy->max)
1765 target_freq = policy->max;
1766 if (target_freq < policy->min)
1767 target_freq = policy->min;
1768
1769 pr_debug("target for CPU %u: %u kHz, relation %u, requested %u kHz\n",
1770 policy->cpu, target_freq, relation, old_target_freq);
5a1c0228 1771
9c0ebcf7
VK
1772 /*
1773 * This might look like a redundant call as we are checking it again
1774 * after finding index. But it is left intentionally for cases where
1775 * exactly same freq is called again and so we can save on few function
1776 * calls.
1777 */
5a1c0228
VK
1778 if (target_freq == policy->cur)
1779 return 0;
1780
1c3d85dd
RW
1781 if (cpufreq_driver->target)
1782 retval = cpufreq_driver->target(policy, target_freq, relation);
9c0ebcf7
VK
1783 else if (cpufreq_driver->target_index) {
1784 struct cpufreq_frequency_table *freq_table;
d4019f0a
VK
1785 struct cpufreq_freqs freqs;
1786 bool notify;
9c0ebcf7 1787 int index;
90d45d17 1788
9c0ebcf7
VK
1789 freq_table = cpufreq_frequency_get_table(policy->cpu);
1790 if (unlikely(!freq_table)) {
1791 pr_err("%s: Unable to find freq_table\n", __func__);
1792 goto out;
1793 }
1794
1795 retval = cpufreq_frequency_table_target(policy, freq_table,
1796 target_freq, relation, &index);
1797 if (unlikely(retval)) {
1798 pr_err("%s: Unable to find matching freq\n", __func__);
1799 goto out;
1800 }
1801
d4019f0a 1802 if (freq_table[index].frequency == policy->cur) {
9c0ebcf7 1803 retval = 0;
d4019f0a
VK
1804 goto out;
1805 }
1806
1807 notify = !(cpufreq_driver->flags & CPUFREQ_ASYNC_NOTIFICATION);
1808
1809 if (notify) {
1810 freqs.old = policy->cur;
1811 freqs.new = freq_table[index].frequency;
1812 freqs.flags = 0;
1813
1814 pr_debug("%s: cpu: %d, oldfreq: %u, new freq: %u\n",
1815 __func__, policy->cpu, freqs.old,
1816 freqs.new);
1817
1818 cpufreq_notify_transition(policy, &freqs,
1819 CPUFREQ_PRECHANGE);
1820 }
1821
1822 retval = cpufreq_driver->target_index(policy, index);
1823 if (retval)
1824 pr_err("%s: Failed to change cpu frequency: %d\n",
1825 __func__, retval);
1826
ab1b1c4e
VK
1827 if (notify)
1828 cpufreq_notify_post_transition(policy, &freqs, retval);
9c0ebcf7
VK
1829 }
1830
1831out:
1da177e4
LT
1832 return retval;
1833}
1834EXPORT_SYMBOL_GPL(__cpufreq_driver_target);
1835
1da177e4
LT
1836int cpufreq_driver_target(struct cpufreq_policy *policy,
1837 unsigned int target_freq,
1838 unsigned int relation)
1839{
f1829e4a 1840 int ret = -EINVAL;
1da177e4 1841
ad7722da 1842 down_write(&policy->rwsem);
1da177e4
LT
1843
1844 ret = __cpufreq_driver_target(policy, target_freq, relation);
1845
ad7722da 1846 up_write(&policy->rwsem);
1da177e4 1847
1da177e4
LT
1848 return ret;
1849}
1850EXPORT_SYMBOL_GPL(cpufreq_driver_target);
1851
153d7f3f 1852/*
153d7f3f
AV
1853 * when "event" is CPUFREQ_GOV_LIMITS
1854 */
1da177e4 1855
e08f5f5b
GS
1856static int __cpufreq_governor(struct cpufreq_policy *policy,
1857 unsigned int event)
1da177e4 1858{
cc993cab 1859 int ret;
6afde10c
TR
1860
1861 /* Only must be defined when default governor is known to have latency
1862 restrictions, like e.g. conservative or ondemand.
1863 That this is the case is already ensured in Kconfig
1864 */
1865#ifdef CONFIG_CPU_FREQ_GOV_PERFORMANCE
1866 struct cpufreq_governor *gov = &cpufreq_gov_performance;
1867#else
1868 struct cpufreq_governor *gov = NULL;
1869#endif
1c256245
TR
1870
1871 if (policy->governor->max_transition_latency &&
1872 policy->cpuinfo.transition_latency >
1873 policy->governor->max_transition_latency) {
6afde10c
TR
1874 if (!gov)
1875 return -EINVAL;
1876 else {
1877 printk(KERN_WARNING "%s governor failed, too long"
1878 " transition latency of HW, fallback"
1879 " to %s governor\n",
1880 policy->governor->name,
1881 gov->name);
1882 policy->governor = gov;
1883 }
1c256245 1884 }
1da177e4 1885
fe492f3f
VK
1886 if (event == CPUFREQ_GOV_POLICY_INIT)
1887 if (!try_module_get(policy->governor->owner))
1888 return -EINVAL;
1da177e4 1889
2d06d8c4 1890 pr_debug("__cpufreq_governor for CPU %u, event %u\n",
e08f5f5b 1891 policy->cpu, event);
95731ebb
XC
1892
1893 mutex_lock(&cpufreq_governor_lock);
56d07db2 1894 if ((policy->governor_enabled && event == CPUFREQ_GOV_START)
f73d3933
VK
1895 || (!policy->governor_enabled
1896 && (event == CPUFREQ_GOV_LIMITS || event == CPUFREQ_GOV_STOP))) {
95731ebb
XC
1897 mutex_unlock(&cpufreq_governor_lock);
1898 return -EBUSY;
1899 }
1900
1901 if (event == CPUFREQ_GOV_STOP)
1902 policy->governor_enabled = false;
1903 else if (event == CPUFREQ_GOV_START)
1904 policy->governor_enabled = true;
1905
1906 mutex_unlock(&cpufreq_governor_lock);
1907
1da177e4
LT
1908 ret = policy->governor->governor(policy, event);
1909
4d5dcc42
VK
1910 if (!ret) {
1911 if (event == CPUFREQ_GOV_POLICY_INIT)
1912 policy->governor->initialized++;
1913 else if (event == CPUFREQ_GOV_POLICY_EXIT)
1914 policy->governor->initialized--;
95731ebb
XC
1915 } else {
1916 /* Restore original values */
1917 mutex_lock(&cpufreq_governor_lock);
1918 if (event == CPUFREQ_GOV_STOP)
1919 policy->governor_enabled = true;
1920 else if (event == CPUFREQ_GOV_START)
1921 policy->governor_enabled = false;
1922 mutex_unlock(&cpufreq_governor_lock);
4d5dcc42 1923 }
b394058f 1924
fe492f3f
VK
1925 if (((event == CPUFREQ_GOV_POLICY_INIT) && ret) ||
1926 ((event == CPUFREQ_GOV_POLICY_EXIT) && !ret))
1da177e4
LT
1927 module_put(policy->governor->owner);
1928
1929 return ret;
1930}
1931
1da177e4
LT
1932int cpufreq_register_governor(struct cpufreq_governor *governor)
1933{
3bcb09a3 1934 int err;
1da177e4
LT
1935
1936 if (!governor)
1937 return -EINVAL;
1938
a7b422cd
KRW
1939 if (cpufreq_disabled())
1940 return -ENODEV;
1941
3fc54d37 1942 mutex_lock(&cpufreq_governor_mutex);
32ee8c3e 1943
b394058f 1944 governor->initialized = 0;
3bcb09a3
JF
1945 err = -EBUSY;
1946 if (__find_governor(governor->name) == NULL) {
1947 err = 0;
1948 list_add(&governor->governor_list, &cpufreq_governor_list);
1da177e4 1949 }
1da177e4 1950
32ee8c3e 1951 mutex_unlock(&cpufreq_governor_mutex);
3bcb09a3 1952 return err;
1da177e4
LT
1953}
1954EXPORT_SYMBOL_GPL(cpufreq_register_governor);
1955
1da177e4
LT
1956void cpufreq_unregister_governor(struct cpufreq_governor *governor)
1957{
90e41bac
PB
1958#ifdef CONFIG_HOTPLUG_CPU
1959 int cpu;
1960#endif
1961
1da177e4
LT
1962 if (!governor)
1963 return;
1964
a7b422cd
KRW
1965 if (cpufreq_disabled())
1966 return;
1967
90e41bac
PB
1968#ifdef CONFIG_HOTPLUG_CPU
1969 for_each_present_cpu(cpu) {
1970 if (cpu_online(cpu))
1971 continue;
1972 if (!strcmp(per_cpu(cpufreq_cpu_governor, cpu), governor->name))
1973 strcpy(per_cpu(cpufreq_cpu_governor, cpu), "\0");
1974 }
1975#endif
1976
3fc54d37 1977 mutex_lock(&cpufreq_governor_mutex);
1da177e4 1978 list_del(&governor->governor_list);
3fc54d37 1979 mutex_unlock(&cpufreq_governor_mutex);
1da177e4
LT
1980 return;
1981}
1982EXPORT_SYMBOL_GPL(cpufreq_unregister_governor);
1983
1984
1da177e4
LT
1985/*********************************************************************
1986 * POLICY INTERFACE *
1987 *********************************************************************/
1988
1989/**
1990 * cpufreq_get_policy - get the current cpufreq_policy
29464f28
DJ
1991 * @policy: struct cpufreq_policy into which the current cpufreq_policy
1992 * is written
1da177e4
LT
1993 *
1994 * Reads the current cpufreq policy.
1995 */
1996int cpufreq_get_policy(struct cpufreq_policy *policy, unsigned int cpu)
1997{
1998 struct cpufreq_policy *cpu_policy;
1999 if (!policy)
2000 return -EINVAL;
2001
2002 cpu_policy = cpufreq_cpu_get(cpu);
2003 if (!cpu_policy)
2004 return -EINVAL;
2005
d5b73cd8 2006 memcpy(policy, cpu_policy, sizeof(*policy));
1da177e4
LT
2007
2008 cpufreq_cpu_put(cpu_policy);
1da177e4
LT
2009 return 0;
2010}
2011EXPORT_SYMBOL(cpufreq_get_policy);
2012
153d7f3f 2013/*
037ce839
VK
2014 * policy : current policy.
2015 * new_policy: policy to be set.
153d7f3f 2016 */
037ce839 2017static int cpufreq_set_policy(struct cpufreq_policy *policy,
3a3e9e06 2018 struct cpufreq_policy *new_policy)
1da177e4 2019{
d9a789c7
RW
2020 struct cpufreq_governor *old_gov;
2021 int ret;
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
d9a789c7
RW
2028 if (new_policy->min > policy->max || new_policy->max < policy->min)
2029 return -EINVAL;
9c9a43ed 2030
1da177e4 2031 /* verify the cpu speed can be set within this limit */
3a3e9e06 2032 ret = cpufreq_driver->verify(new_policy);
1da177e4 2033 if (ret)
d9a789c7 2034 return ret;
1da177e4 2035
1da177e4 2036 /* adjust if necessary - all reasons */
e041c683 2037 blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
3a3e9e06 2038 CPUFREQ_ADJUST, new_policy);
1da177e4
LT
2039
2040 /* adjust if necessary - hardware incompatibility*/
e041c683 2041 blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
3a3e9e06 2042 CPUFREQ_INCOMPATIBLE, new_policy);
1da177e4 2043
bb176f7d
VK
2044 /*
2045 * verify the cpu speed can be set within this limit, which might be
2046 * different to the first one
2047 */
3a3e9e06 2048 ret = cpufreq_driver->verify(new_policy);
e041c683 2049 if (ret)
d9a789c7 2050 return ret;
1da177e4
LT
2051
2052 /* notification of the new policy */
e041c683 2053 blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
3a3e9e06 2054 CPUFREQ_NOTIFY, new_policy);
1da177e4 2055
3a3e9e06
VK
2056 policy->min = new_policy->min;
2057 policy->max = new_policy->max;
1da177e4 2058
2d06d8c4 2059 pr_debug("new min and max freqs are %u - %u kHz\n",
3a3e9e06 2060 policy->min, policy->max);
1da177e4 2061
1c3d85dd 2062 if (cpufreq_driver->setpolicy) {
3a3e9e06 2063 policy->policy = new_policy->policy;
2d06d8c4 2064 pr_debug("setting range\n");
d9a789c7
RW
2065 return cpufreq_driver->setpolicy(new_policy);
2066 }
1da177e4 2067
d9a789c7
RW
2068 if (new_policy->governor == policy->governor)
2069 goto out;
7bd353a9 2070
d9a789c7
RW
2071 pr_debug("governor switch\n");
2072
2073 /* save old, working values */
2074 old_gov = policy->governor;
2075 /* end old governor */
2076 if (old_gov) {
2077 __cpufreq_governor(policy, CPUFREQ_GOV_STOP);
2078 up_write(&policy->rwsem);
2079 __cpufreq_governor(policy,CPUFREQ_GOV_POLICY_EXIT);
2080 down_write(&policy->rwsem);
1da177e4
LT
2081 }
2082
d9a789c7
RW
2083 /* start new governor */
2084 policy->governor = new_policy->governor;
2085 if (!__cpufreq_governor(policy, CPUFREQ_GOV_POLICY_INIT)) {
2086 if (!__cpufreq_governor(policy, CPUFREQ_GOV_START))
2087 goto out;
2088
2089 up_write(&policy->rwsem);
2090 __cpufreq_governor(policy, CPUFREQ_GOV_POLICY_EXIT);
2091 down_write(&policy->rwsem);
2092 }
2093
2094 /* new governor failed, so re-start old one */
2095 pr_debug("starting governor %s failed\n", policy->governor->name);
2096 if (old_gov) {
2097 policy->governor = old_gov;
2098 __cpufreq_governor(policy, CPUFREQ_GOV_POLICY_INIT);
2099 __cpufreq_governor(policy, CPUFREQ_GOV_START);
2100 }
2101
2102 return -EINVAL;
2103
2104 out:
2105 pr_debug("governor: change or update limits\n");
2106 return __cpufreq_governor(policy, CPUFREQ_GOV_LIMITS);
1da177e4
LT
2107}
2108
1da177e4
LT
2109/**
2110 * cpufreq_update_policy - re-evaluate an existing cpufreq policy
2111 * @cpu: CPU which shall be re-evaluated
2112 *
25985edc 2113 * Useful for policy notifiers which have different necessities
1da177e4
LT
2114 * at different times.
2115 */
2116int cpufreq_update_policy(unsigned int cpu)
2117{
3a3e9e06
VK
2118 struct cpufreq_policy *policy = cpufreq_cpu_get(cpu);
2119 struct cpufreq_policy new_policy;
f1829e4a 2120 int ret;
1da177e4 2121
3a3e9e06 2122 if (!policy) {
f1829e4a
JL
2123 ret = -ENODEV;
2124 goto no_policy;
2125 }
1da177e4 2126
ad7722da 2127 down_write(&policy->rwsem);
1da177e4 2128
2d06d8c4 2129 pr_debug("updating policy for CPU %u\n", cpu);
d5b73cd8 2130 memcpy(&new_policy, policy, sizeof(*policy));
3a3e9e06
VK
2131 new_policy.min = policy->user_policy.min;
2132 new_policy.max = policy->user_policy.max;
2133 new_policy.policy = policy->user_policy.policy;
2134 new_policy.governor = policy->user_policy.governor;
1da177e4 2135
bb176f7d
VK
2136 /*
2137 * BIOS might change freq behind our back
2138 * -> ask driver for current freq and notify governors about a change
2139 */
1c3d85dd 2140 if (cpufreq_driver->get) {
3a3e9e06
VK
2141 new_policy.cur = cpufreq_driver->get(cpu);
2142 if (!policy->cur) {
2d06d8c4 2143 pr_debug("Driver did not initialize current freq");
3a3e9e06 2144 policy->cur = new_policy.cur;
a85f7bd3 2145 } else {
9c0ebcf7 2146 if (policy->cur != new_policy.cur && has_target())
3a3e9e06
VK
2147 cpufreq_out_of_sync(cpu, policy->cur,
2148 new_policy.cur);
a85f7bd3 2149 }
0961dd0d
TR
2150 }
2151
037ce839 2152 ret = cpufreq_set_policy(policy, &new_policy);
1da177e4 2153
ad7722da 2154 up_write(&policy->rwsem);
5a01f2e8 2155
3a3e9e06 2156 cpufreq_cpu_put(policy);
f1829e4a 2157no_policy:
1da177e4
LT
2158 return ret;
2159}
2160EXPORT_SYMBOL(cpufreq_update_policy);
2161
2760984f 2162static int cpufreq_cpu_callback(struct notifier_block *nfb,
c32b6b8e
AR
2163 unsigned long action, void *hcpu)
2164{
2165 unsigned int cpu = (unsigned long)hcpu;
8a25a2fd 2166 struct device *dev;
5302c3fb 2167 bool frozen = false;
c32b6b8e 2168
8a25a2fd
KS
2169 dev = get_cpu_device(cpu);
2170 if (dev) {
5302c3fb 2171
d4faadd5
RW
2172 if (action & CPU_TASKS_FROZEN)
2173 frozen = true;
2174
5302c3fb 2175 switch (action & ~CPU_TASKS_FROZEN) {
c32b6b8e 2176 case CPU_ONLINE:
5302c3fb 2177 __cpufreq_add_dev(dev, NULL, frozen);
c32b6b8e 2178 break;
5302c3fb 2179
c32b6b8e 2180 case CPU_DOWN_PREPARE:
cedb70af 2181 __cpufreq_remove_dev_prepare(dev, NULL, frozen);
1aee40ac
SB
2182 break;
2183
2184 case CPU_POST_DEAD:
cedb70af 2185 __cpufreq_remove_dev_finish(dev, NULL, frozen);
c32b6b8e 2186 break;
5302c3fb 2187
5a01f2e8 2188 case CPU_DOWN_FAILED:
5302c3fb 2189 __cpufreq_add_dev(dev, NULL, frozen);
c32b6b8e
AR
2190 break;
2191 }
2192 }
2193 return NOTIFY_OK;
2194}
2195
9c36f746 2196static struct notifier_block __refdata cpufreq_cpu_notifier = {
bb176f7d 2197 .notifier_call = cpufreq_cpu_callback,
c32b6b8e 2198};
1da177e4 2199
6f19efc0
LM
2200/*********************************************************************
2201 * BOOST *
2202 *********************************************************************/
2203static int cpufreq_boost_set_sw(int state)
2204{
2205 struct cpufreq_frequency_table *freq_table;
2206 struct cpufreq_policy *policy;
2207 int ret = -EINVAL;
2208
2209 list_for_each_entry(policy, &cpufreq_policy_list, policy_list) {
2210 freq_table = cpufreq_frequency_get_table(policy->cpu);
2211 if (freq_table) {
2212 ret = cpufreq_frequency_table_cpuinfo(policy,
2213 freq_table);
2214 if (ret) {
2215 pr_err("%s: Policy frequency update failed\n",
2216 __func__);
2217 break;
2218 }
2219 policy->user_policy.max = policy->max;
2220 __cpufreq_governor(policy, CPUFREQ_GOV_LIMITS);
2221 }
2222 }
2223
2224 return ret;
2225}
2226
2227int cpufreq_boost_trigger_state(int state)
2228{
2229 unsigned long flags;
2230 int ret = 0;
2231
2232 if (cpufreq_driver->boost_enabled == state)
2233 return 0;
2234
2235 write_lock_irqsave(&cpufreq_driver_lock, flags);
2236 cpufreq_driver->boost_enabled = state;
2237 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
2238
2239 ret = cpufreq_driver->set_boost(state);
2240 if (ret) {
2241 write_lock_irqsave(&cpufreq_driver_lock, flags);
2242 cpufreq_driver->boost_enabled = !state;
2243 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
2244
2245 pr_err("%s: Cannot %s BOOST\n", __func__,
2246 state ? "enable" : "disable");
2247 }
2248
2249 return ret;
2250}
2251
2252int cpufreq_boost_supported(void)
2253{
2254 if (likely(cpufreq_driver))
2255 return cpufreq_driver->boost_supported;
2256
2257 return 0;
2258}
2259EXPORT_SYMBOL_GPL(cpufreq_boost_supported);
2260
2261int cpufreq_boost_enabled(void)
2262{
2263 return cpufreq_driver->boost_enabled;
2264}
2265EXPORT_SYMBOL_GPL(cpufreq_boost_enabled);
2266
1da177e4
LT
2267/*********************************************************************
2268 * REGISTER / UNREGISTER CPUFREQ DRIVER *
2269 *********************************************************************/
2270
2271/**
2272 * cpufreq_register_driver - register a CPU Frequency driver
2273 * @driver_data: A struct cpufreq_driver containing the values#
2274 * submitted by the CPU Frequency driver.
2275 *
bb176f7d 2276 * Registers a CPU Frequency driver to this core code. This code
1da177e4 2277 * returns zero on success, -EBUSY when another driver got here first
32ee8c3e 2278 * (and isn't unregistered in the meantime).
1da177e4
LT
2279 *
2280 */
221dee28 2281int cpufreq_register_driver(struct cpufreq_driver *driver_data)
1da177e4
LT
2282{
2283 unsigned long flags;
2284 int ret;
2285
a7b422cd
KRW
2286 if (cpufreq_disabled())
2287 return -ENODEV;
2288
1da177e4 2289 if (!driver_data || !driver_data->verify || !driver_data->init ||
9c0ebcf7
VK
2290 !(driver_data->setpolicy || driver_data->target_index ||
2291 driver_data->target))
1da177e4
LT
2292 return -EINVAL;
2293
2d06d8c4 2294 pr_debug("trying to register driver %s\n", driver_data->name);
1da177e4
LT
2295
2296 if (driver_data->setpolicy)
2297 driver_data->flags |= CPUFREQ_CONST_LOOPS;
2298
0d1857a1 2299 write_lock_irqsave(&cpufreq_driver_lock, flags);
1c3d85dd 2300 if (cpufreq_driver) {
0d1857a1 2301 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
4dea5806 2302 return -EEXIST;
1da177e4 2303 }
1c3d85dd 2304 cpufreq_driver = driver_data;
0d1857a1 2305 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
1da177e4 2306
6f19efc0
LM
2307 if (cpufreq_boost_supported()) {
2308 /*
2309 * Check if driver provides function to enable boost -
2310 * if not, use cpufreq_boost_set_sw as default
2311 */
2312 if (!cpufreq_driver->set_boost)
2313 cpufreq_driver->set_boost = cpufreq_boost_set_sw;
2314
2315 ret = cpufreq_sysfs_create_file(&boost.attr);
2316 if (ret) {
2317 pr_err("%s: cannot register global BOOST sysfs file\n",
2318 __func__);
2319 goto err_null_driver;
2320 }
2321 }
2322
8a25a2fd 2323 ret = subsys_interface_register(&cpufreq_interface);
8f5bc2ab 2324 if (ret)
6f19efc0 2325 goto err_boost_unreg;
1da177e4 2326
1c3d85dd 2327 if (!(cpufreq_driver->flags & CPUFREQ_STICKY)) {
1da177e4
LT
2328 int i;
2329 ret = -ENODEV;
2330
2331 /* check for at least one working CPU */
7a6aedfa
MT
2332 for (i = 0; i < nr_cpu_ids; i++)
2333 if (cpu_possible(i) && per_cpu(cpufreq_cpu_data, i)) {
1da177e4 2334 ret = 0;
7a6aedfa
MT
2335 break;
2336 }
1da177e4
LT
2337
2338 /* if all ->init() calls failed, unregister */
2339 if (ret) {
2d06d8c4 2340 pr_debug("no CPU initialized for driver %s\n",
e08f5f5b 2341 driver_data->name);
8a25a2fd 2342 goto err_if_unreg;
1da177e4
LT
2343 }
2344 }
2345
8f5bc2ab 2346 register_hotcpu_notifier(&cpufreq_cpu_notifier);
2d06d8c4 2347 pr_debug("driver %s up and running\n", driver_data->name);
1da177e4 2348
8f5bc2ab 2349 return 0;
8a25a2fd
KS
2350err_if_unreg:
2351 subsys_interface_unregister(&cpufreq_interface);
6f19efc0
LM
2352err_boost_unreg:
2353 if (cpufreq_boost_supported())
2354 cpufreq_sysfs_remove_file(&boost.attr);
8f5bc2ab 2355err_null_driver:
0d1857a1 2356 write_lock_irqsave(&cpufreq_driver_lock, flags);
1c3d85dd 2357 cpufreq_driver = NULL;
0d1857a1 2358 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
4d34a67d 2359 return ret;
1da177e4
LT
2360}
2361EXPORT_SYMBOL_GPL(cpufreq_register_driver);
2362
1da177e4
LT
2363/**
2364 * cpufreq_unregister_driver - unregister the current CPUFreq driver
2365 *
bb176f7d 2366 * Unregister the current CPUFreq driver. Only call this if you have
1da177e4
LT
2367 * the right to do so, i.e. if you have succeeded in initialising before!
2368 * Returns zero if successful, and -EINVAL if the cpufreq_driver is
2369 * currently not initialised.
2370 */
221dee28 2371int cpufreq_unregister_driver(struct cpufreq_driver *driver)
1da177e4
LT
2372{
2373 unsigned long flags;
2374
1c3d85dd 2375 if (!cpufreq_driver || (driver != cpufreq_driver))
1da177e4 2376 return -EINVAL;
1da177e4 2377
2d06d8c4 2378 pr_debug("unregistering driver %s\n", driver->name);
1da177e4 2379
8a25a2fd 2380 subsys_interface_unregister(&cpufreq_interface);
6f19efc0
LM
2381 if (cpufreq_boost_supported())
2382 cpufreq_sysfs_remove_file(&boost.attr);
2383
65edc68c 2384 unregister_hotcpu_notifier(&cpufreq_cpu_notifier);
1da177e4 2385
6eed9404 2386 down_write(&cpufreq_rwsem);
0d1857a1 2387 write_lock_irqsave(&cpufreq_driver_lock, flags);
6eed9404 2388
1c3d85dd 2389 cpufreq_driver = NULL;
6eed9404 2390
0d1857a1 2391 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
6eed9404 2392 up_write(&cpufreq_rwsem);
1da177e4
LT
2393
2394 return 0;
2395}
2396EXPORT_SYMBOL_GPL(cpufreq_unregister_driver);
5a01f2e8
VP
2397
2398static int __init cpufreq_core_init(void)
2399{
a7b422cd
KRW
2400 if (cpufreq_disabled())
2401 return -ENODEV;
2402
2361be23 2403 cpufreq_global_kobject = kobject_create();
8aa84ad8 2404 BUG_ON(!cpufreq_global_kobject);
e00e56df 2405 register_syscore_ops(&cpufreq_syscore_ops);
8aa84ad8 2406
5a01f2e8
VP
2407 return 0;
2408}
5a01f2e8 2409core_initcall(cpufreq_core_init);