blob: 3c56c4759aa1db59f04a6a9444f5c3fa60299fe0 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * linux/drivers/cpufreq/cpufreq.c
3 *
4 * Copyright (C) 2001 Russell King
5 * (C) 2002 - 2003 Dominik Brodowski <linux@brodo.de>
Viresh Kumarbb176f72013-06-19 14:19:33 +05306 * (C) 2013 Viresh Kumar <viresh.kumar@linaro.org>
Linus Torvalds1da177e2005-04-16 15:20:36 -07007 *
Ashok Rajc32b6b82005-10-30 14:59:54 -08008 * Oct 2005 - Ashok Raj <ashok.raj@intel.com>
Dave Jones32ee8c32006-02-28 00:43:23 -05009 * Added handling for CPU hotplug
Dave Jones8ff69732006-03-05 03:37:23 -050010 * Feb 2006 - Jacob Shin <jacob.shin@amd.com>
11 * Fix handling for CPU hotplug -- affected CPUs
Ashok Rajc32b6b82005-10-30 14:59:54 -080012 *
Linus Torvalds1da177e2005-04-16 15:20:36 -070013 * 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.
Linus Torvalds1da177e2005-04-16 15:20:36 -070016 */
17
Viresh Kumardb701152012-10-23 01:29:03 +020018#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
19
Viresh Kumar5ff0a262013-08-06 22:53:03 +053020#include <linux/cpu.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070021#include <linux/cpufreq.h>
22#include <linux/delay.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070023#include <linux/device.h>
Viresh Kumar5ff0a262013-08-06 22:53:03 +053024#include <linux/init.h>
25#include <linux/kernel_stat.h>
26#include <linux/module.h>
akpm@osdl.org3fc54d32006-01-13 15:54:22 -080027#include <linux/mutex.h>
Viresh Kumar5ff0a262013-08-06 22:53:03 +053028#include <linux/slab.h>
Viresh Kumar2f0aea92014-03-04 11:00:26 +080029#include <linux/suspend.h>
Viresh Kumar5ff0a262013-08-06 22:53:03 +053030#include <linux/tick.h>
Thomas Renninger6f4f2722010-04-20 13:17:36 +020031#include <trace/events/power.h>
32
Linus Torvalds1da177e2005-04-16 15:20:36 -070033/**
Dave Jonescd878472006-08-11 17:59:28 -040034 * The "cpufreq driver" - the arch- or hardware-dependent low
Linus Torvalds1da177e2005-04-16 15:20:36 -070035 * level driver of CPUFreq support, and its spinlock. This lock
36 * also protects the cpufreq_cpu_data array.
37 */
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +020038static struct cpufreq_driver *cpufreq_driver;
Mike Travis7a6aedf2008-03-25 15:06:53 -070039static DEFINE_PER_CPU(struct cpufreq_policy *, cpufreq_cpu_data);
Srivatsa S. Bhat84148092013-07-30 04:25:10 +053040static DEFINE_PER_CPU(struct cpufreq_policy *, cpufreq_cpu_data_fallback);
Viresh Kumarbb176f72013-06-19 14:19:33 +053041static DEFINE_RWLOCK(cpufreq_driver_lock);
Jane Li6f1e4ef2014-01-03 17:17:41 +080042DEFINE_MUTEX(cpufreq_governor_lock);
Lukasz Majewskic88a1f82013-08-06 22:53:08 +053043static LIST_HEAD(cpufreq_policy_list);
Viresh Kumarbb176f72013-06-19 14:19:33 +053044
Thomas Renninger084f3492007-07-09 11:35:28 -070045/* This one keeps track of the previously set governor of a removed CPU */
Dmitry Monakhove77b89f2009-10-05 00:38:55 +040046static DEFINE_PER_CPU(char[CPUFREQ_NAME_LEN], cpufreq_cpu_governor);
Linus Torvalds1da177e2005-04-16 15:20:36 -070047
Viresh Kumar2f0aea92014-03-04 11:00:26 +080048/* Flag to suspend/resume CPUFreq governors */
49static bool cpufreq_suspended;
Linus Torvalds1da177e2005-04-16 15:20:36 -070050
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +053051static inline bool has_target(void)
52{
53 return cpufreq_driver->target_index || cpufreq_driver->target;
54}
55
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -080056/*
Viresh Kumar6eed9402013-08-06 22:53:11 +053057 * rwsem to guarantee that cpufreq driver module doesn't unload during critical
58 * sections
59 */
60static DECLARE_RWSEM(cpufreq_rwsem);
61
Linus Torvalds1da177e2005-04-16 15:20:36 -070062/* internal prototypes */
Dave Jones29464f22009-01-18 01:37:11 -050063static int __cpufreq_governor(struct cpufreq_policy *policy,
64 unsigned int event);
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -080065static unsigned int __cpufreq_get(unsigned int cpu);
David Howells65f27f32006-11-22 14:55:48 +000066static void handle_update(struct work_struct *work);
Linus Torvalds1da177e2005-04-16 15:20:36 -070067
68/**
Dave Jones32ee8c32006-02-28 00:43:23 -050069 * Two notifier lists: the "policy" list is involved in the
70 * validation process for a new CPU frequency policy; the
Linus Torvalds1da177e2005-04-16 15:20:36 -070071 * "transition" list for kernel code that needs to handle
72 * changes to devices when the CPU clock speed changes.
73 * The mutex locks both lists.
74 */
Alan Sterne041c682006-03-27 01:16:30 -080075static BLOCKING_NOTIFIER_HEAD(cpufreq_policy_notifier_list);
Alan Sternb4dfdbb2006-10-04 02:17:06 -070076static struct srcu_notifier_head cpufreq_transition_notifier_list;
Linus Torvalds1da177e2005-04-16 15:20:36 -070077
Cesar Eduardo Barros74212ca2008-02-16 08:41:24 -020078static bool init_cpufreq_transition_notifier_list_called;
Alan Sternb4dfdbb2006-10-04 02:17:06 -070079static int __init init_cpufreq_transition_notifier_list(void)
80{
81 srcu_init_notifier_head(&cpufreq_transition_notifier_list);
Cesar Eduardo Barros74212ca2008-02-16 08:41:24 -020082 init_cpufreq_transition_notifier_list_called = true;
Alan Sternb4dfdbb2006-10-04 02:17:06 -070083 return 0;
84}
Linus Torvaldsb3438f82006-11-20 11:47:18 -080085pure_initcall(init_cpufreq_transition_notifier_list);
Linus Torvalds1da177e2005-04-16 15:20:36 -070086
Konrad Rzeszutek Wilka7b422c2012-03-13 19:18:39 -040087static int off __read_mostly;
Viresh Kumarda584452012-10-26 00:51:32 +020088static int cpufreq_disabled(void)
Konrad Rzeszutek Wilka7b422c2012-03-13 19:18:39 -040089{
90 return off;
91}
92void disable_cpufreq(void)
93{
94 off = 1;
95}
Linus Torvalds1da177e2005-04-16 15:20:36 -070096static LIST_HEAD(cpufreq_governor_list);
Dave Jones29464f22009-01-18 01:37:11 -050097static DEFINE_MUTEX(cpufreq_governor_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -070098
Viresh Kumar4d5dcc42013-03-27 15:58:58 +000099bool have_governor_per_policy(void)
100{
Viresh Kumar0b981e72013-10-02 14:13:18 +0530101 return !!(cpufreq_driver->flags & CPUFREQ_HAVE_GOVERNOR_PER_POLICY);
Viresh Kumar4d5dcc42013-03-27 15:58:58 +0000102}
Viresh Kumar3f869d62013-05-16 05:09:56 +0000103EXPORT_SYMBOL_GPL(have_governor_per_policy);
Viresh Kumar4d5dcc42013-03-27 15:58:58 +0000104
Viresh Kumar944e9a02013-05-16 05:09:57 +0000105struct kobject *get_governor_parent_kobj(struct cpufreq_policy *policy)
106{
107 if (have_governor_per_policy())
108 return &policy->kobj;
109 else
110 return cpufreq_global_kobject;
111}
112EXPORT_SYMBOL_GPL(get_governor_parent_kobj);
113
Viresh Kumar72a4ce32013-05-17 11:26:32 +0000114static inline u64 get_cpu_idle_time_jiffy(unsigned int cpu, u64 *wall)
115{
116 u64 idle_time;
117 u64 cur_wall_time;
118 u64 busy_time;
119
120 cur_wall_time = jiffies64_to_cputime64(get_jiffies_64());
121
122 busy_time = kcpustat_cpu(cpu).cpustat[CPUTIME_USER];
123 busy_time += kcpustat_cpu(cpu).cpustat[CPUTIME_SYSTEM];
124 busy_time += kcpustat_cpu(cpu).cpustat[CPUTIME_IRQ];
125 busy_time += kcpustat_cpu(cpu).cpustat[CPUTIME_SOFTIRQ];
126 busy_time += kcpustat_cpu(cpu).cpustat[CPUTIME_STEAL];
127 busy_time += kcpustat_cpu(cpu).cpustat[CPUTIME_NICE];
128
129 idle_time = cur_wall_time - busy_time;
130 if (wall)
131 *wall = cputime_to_usecs(cur_wall_time);
132
133 return cputime_to_usecs(idle_time);
134}
135
136u64 get_cpu_idle_time(unsigned int cpu, u64 *wall, int io_busy)
137{
138 u64 idle_time = get_cpu_idle_time_us(cpu, io_busy ? wall : NULL);
139
140 if (idle_time == -1ULL)
141 return get_cpu_idle_time_jiffy(cpu, wall);
142 else if (!io_busy)
143 idle_time += get_cpu_iowait_time_us(cpu, wall);
144
145 return idle_time;
146}
147EXPORT_SYMBOL_GPL(get_cpu_idle_time);
148
Viresh Kumar70e9e772013-10-03 20:29:07 +0530149/*
150 * This is a generic cpufreq init() routine which can be used by cpufreq
151 * drivers of SMP systems. It will do following:
152 * - validate & show freq table passed
153 * - set policies transition latency
154 * - policy->cpus with all possible CPUs
155 */
156int cpufreq_generic_init(struct cpufreq_policy *policy,
157 struct cpufreq_frequency_table *table,
158 unsigned int transition_latency)
159{
160 int ret;
161
162 ret = cpufreq_table_validate_and_show(policy, table);
163 if (ret) {
164 pr_err("%s: invalid frequency table: %d\n", __func__, ret);
165 return ret;
166 }
167
168 policy->cpuinfo.transition_latency = transition_latency;
169
170 /*
171 * The driver only supports the SMP configuartion where all processors
172 * share the clock and voltage and clock.
173 */
174 cpumask_setall(policy->cpus);
175
176 return 0;
177}
178EXPORT_SYMBOL_GPL(cpufreq_generic_init);
179
Viresh Kumar652ed952014-01-09 20:38:43 +0530180unsigned int cpufreq_generic_get(unsigned int cpu)
181{
182 struct cpufreq_policy *policy = per_cpu(cpufreq_cpu_data, cpu);
183
184 if (!policy || IS_ERR(policy->clk)) {
Joe Perchese837f9b2014-03-11 10:03:00 -0700185 pr_err("%s: No %s associated to cpu: %d\n",
186 __func__, policy ? "clk" : "policy", cpu);
Viresh Kumar652ed952014-01-09 20:38:43 +0530187 return 0;
188 }
189
190 return clk_get_rate(policy->clk) / 1000;
191}
192EXPORT_SYMBOL_GPL(cpufreq_generic_get);
193
Viresh Kumare0b31652014-03-10 14:53:33 +0530194/* Only for cpufreq core internal use */
195struct cpufreq_policy *cpufreq_cpu_get_raw(unsigned int cpu)
196{
197 return per_cpu(cpufreq_cpu_data, cpu);
198}
199
Viresh Kumar6eed9402013-08-06 22:53:11 +0530200struct cpufreq_policy *cpufreq_cpu_get(unsigned int cpu)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700201{
Viresh Kumar6eed9402013-08-06 22:53:11 +0530202 struct cpufreq_policy *policy = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700203 unsigned long flags;
204
Viresh Kumar6eed9402013-08-06 22:53:11 +0530205 if (cpufreq_disabled() || (cpu >= nr_cpu_ids))
206 return NULL;
207
208 if (!down_read_trylock(&cpufreq_rwsem))
209 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700210
211 /* get the cpufreq driver */
Nathan Zimmer0d1857a2013-02-22 16:24:34 +0000212 read_lock_irqsave(&cpufreq_driver_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700213
Viresh Kumar6eed9402013-08-06 22:53:11 +0530214 if (cpufreq_driver) {
215 /* get the CPU */
216 policy = per_cpu(cpufreq_cpu_data, cpu);
217 if (policy)
218 kobject_get(&policy->kobj);
219 }
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +0200220
Viresh Kumar6eed9402013-08-06 22:53:11 +0530221 read_unlock_irqrestore(&cpufreq_driver_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700222
Viresh Kumar3a3e9e02013-08-06 22:53:05 +0530223 if (!policy)
Viresh Kumar6eed9402013-08-06 22:53:11 +0530224 up_read(&cpufreq_rwsem);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700225
Viresh Kumar3a3e9e02013-08-06 22:53:05 +0530226 return policy;
Stephen Boyda9144432012-07-20 18:14:38 +0000227}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700228EXPORT_SYMBOL_GPL(cpufreq_cpu_get);
229
Viresh Kumar3a3e9e02013-08-06 22:53:05 +0530230void cpufreq_cpu_put(struct cpufreq_policy *policy)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700231{
Dirk Brandewied5aaffa2013-01-17 16:22:21 +0000232 if (cpufreq_disabled())
233 return;
234
Viresh Kumar6eed9402013-08-06 22:53:11 +0530235 kobject_put(&policy->kobj);
236 up_read(&cpufreq_rwsem);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700237}
238EXPORT_SYMBOL_GPL(cpufreq_cpu_put);
239
Linus Torvalds1da177e2005-04-16 15:20:36 -0700240/*********************************************************************
Linus Torvalds1da177e2005-04-16 15:20:36 -0700241 * EXTERNALLY AFFECTING FREQUENCY CHANGES *
242 *********************************************************************/
243
244/**
245 * adjust_jiffies - adjust the system "loops_per_jiffy"
246 *
247 * This function alters the system "loops_per_jiffy" for the clock
248 * speed change. Note that loops_per_jiffy cannot be updated on SMP
Dave Jones32ee8c32006-02-28 00:43:23 -0500249 * systems as each CPU might be scaled differently. So, use the arch
Linus Torvalds1da177e2005-04-16 15:20:36 -0700250 * per-CPU loops_per_jiffy value wherever possible.
251 */
252#ifndef CONFIG_SMP
253static unsigned long l_p_j_ref;
Viresh Kumarbb176f72013-06-19 14:19:33 +0530254static unsigned int l_p_j_ref_freq;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700255
Arjan van de Ven858119e2006-01-14 13:20:43 -0800256static void adjust_jiffies(unsigned long val, struct cpufreq_freqs *ci)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700257{
258 if (ci->flags & CPUFREQ_CONST_LOOPS)
259 return;
260
261 if (!l_p_j_ref_freq) {
262 l_p_j_ref = loops_per_jiffy;
263 l_p_j_ref_freq = ci->old;
Joe Perchese837f9b2014-03-11 10:03:00 -0700264 pr_debug("saving %lu as reference value for loops_per_jiffy; freq is %u kHz\n",
265 l_p_j_ref, l_p_j_ref_freq);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700266 }
Viresh Kumar0b443ea2014-03-19 11:24:58 +0530267 if (val == CPUFREQ_POSTCHANGE && ci->old != ci->new) {
Gautham R Shenoye08f5f52006-10-26 16:20:58 +0530268 loops_per_jiffy = cpufreq_scale(l_p_j_ref, l_p_j_ref_freq,
269 ci->new);
Joe Perchese837f9b2014-03-11 10:03:00 -0700270 pr_debug("scaling loops_per_jiffy to %lu for frequency %u kHz\n",
271 loops_per_jiffy, ci->new);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700272 }
273}
274#else
Gautham R Shenoye08f5f52006-10-26 16:20:58 +0530275static inline void adjust_jiffies(unsigned long val, struct cpufreq_freqs *ci)
276{
277 return;
278}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700279#endif
280
Viresh Kumar0956df9c2013-06-19 14:19:34 +0530281static void __cpufreq_notify_transition(struct cpufreq_policy *policy,
Viresh Kumarb43a7ff2013-03-24 11:56:43 +0530282 struct cpufreq_freqs *freqs, unsigned int state)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700283{
284 BUG_ON(irqs_disabled());
285
Dirk Brandewied5aaffa2013-01-17 16:22:21 +0000286 if (cpufreq_disabled())
287 return;
288
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +0200289 freqs->flags = cpufreq_driver->flags;
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +0200290 pr_debug("notification %u of frequency transition to %u kHz\n",
Joe Perchese837f9b2014-03-11 10:03:00 -0700291 state, freqs->new);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700292
Linus Torvalds1da177e2005-04-16 15:20:36 -0700293 switch (state) {
Dave Jonese4472cb2006-01-31 15:53:55 -0800294
Linus Torvalds1da177e2005-04-16 15:20:36 -0700295 case CPUFREQ_PRECHANGE:
Dave Jones32ee8c32006-02-28 00:43:23 -0500296 /* detect if the driver reported a value as "old frequency"
Dave Jonese4472cb2006-01-31 15:53:55 -0800297 * which is not equal to what the cpufreq core thinks is
298 * "old frequency".
Linus Torvalds1da177e2005-04-16 15:20:36 -0700299 */
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +0200300 if (!(cpufreq_driver->flags & CPUFREQ_CONST_LOOPS)) {
Dave Jonese4472cb2006-01-31 15:53:55 -0800301 if ((policy) && (policy->cpu == freqs->cpu) &&
302 (policy->cur) && (policy->cur != freqs->old)) {
Joe Perchese837f9b2014-03-11 10:03:00 -0700303 pr_debug("Warning: CPU frequency is %u, cpufreq assumed %u kHz\n",
304 freqs->old, policy->cur);
Dave Jonese4472cb2006-01-31 15:53:55 -0800305 freqs->old = policy->cur;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700306 }
307 }
Alan Sternb4dfdbb2006-10-04 02:17:06 -0700308 srcu_notifier_call_chain(&cpufreq_transition_notifier_list,
Alan Sterne041c682006-03-27 01:16:30 -0800309 CPUFREQ_PRECHANGE, freqs);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700310 adjust_jiffies(CPUFREQ_PRECHANGE, freqs);
311 break;
Dave Jonese4472cb2006-01-31 15:53:55 -0800312
Linus Torvalds1da177e2005-04-16 15:20:36 -0700313 case CPUFREQ_POSTCHANGE:
314 adjust_jiffies(CPUFREQ_POSTCHANGE, freqs);
Joe Perchese837f9b2014-03-11 10:03:00 -0700315 pr_debug("FREQ: %lu - CPU: %lu\n",
316 (unsigned long)freqs->new, (unsigned long)freqs->cpu);
Thomas Renninger25e41932011-01-03 17:50:44 +0100317 trace_cpu_frequency(freqs->new, freqs->cpu);
Alan Sternb4dfdbb2006-10-04 02:17:06 -0700318 srcu_notifier_call_chain(&cpufreq_transition_notifier_list,
Alan Sterne041c682006-03-27 01:16:30 -0800319 CPUFREQ_POSTCHANGE, freqs);
Dave Jonese4472cb2006-01-31 15:53:55 -0800320 if (likely(policy) && likely(policy->cpu == freqs->cpu))
321 policy->cur = freqs->new;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700322 break;
323 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700324}
Viresh Kumarbb176f72013-06-19 14:19:33 +0530325
Viresh Kumarb43a7ff2013-03-24 11:56:43 +0530326/**
327 * cpufreq_notify_transition - call notifier chain and adjust_jiffies
328 * on frequency transition.
329 *
330 * This function calls the transition notifiers and the "adjust_jiffies"
331 * function. It is called twice on all CPU frequency changes that have
332 * external effects.
333 */
334void cpufreq_notify_transition(struct cpufreq_policy *policy,
335 struct cpufreq_freqs *freqs, unsigned int state)
336{
337 for_each_cpu(freqs->cpu, policy->cpus)
338 __cpufreq_notify_transition(policy, freqs, state);
339}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700340EXPORT_SYMBOL_GPL(cpufreq_notify_transition);
341
Viresh Kumarf7ba3b42013-12-02 11:04:12 +0530342/* Do post notifications when there are chances that transition has failed */
343void cpufreq_notify_post_transition(struct cpufreq_policy *policy,
344 struct cpufreq_freqs *freqs, int transition_failed)
345{
346 cpufreq_notify_transition(policy, freqs, CPUFREQ_POSTCHANGE);
347 if (!transition_failed)
348 return;
349
350 swap(freqs->old, freqs->new);
351 cpufreq_notify_transition(policy, freqs, CPUFREQ_PRECHANGE);
352 cpufreq_notify_transition(policy, freqs, CPUFREQ_POSTCHANGE);
353}
354EXPORT_SYMBOL_GPL(cpufreq_notify_post_transition);
355
Linus Torvalds1da177e2005-04-16 15:20:36 -0700356
Linus Torvalds1da177e2005-04-16 15:20:36 -0700357/*********************************************************************
358 * SYSFS INTERFACE *
359 *********************************************************************/
Rashika Kheria8a5c74a2014-02-26 22:12:42 +0530360static ssize_t show_boost(struct kobject *kobj,
Lukasz Majewski6f19efc2013-12-20 15:24:49 +0100361 struct attribute *attr, char *buf)
362{
363 return sprintf(buf, "%d\n", cpufreq_driver->boost_enabled);
364}
365
366static ssize_t store_boost(struct kobject *kobj, struct attribute *attr,
367 const char *buf, size_t count)
368{
369 int ret, enable;
370
371 ret = sscanf(buf, "%d", &enable);
372 if (ret != 1 || enable < 0 || enable > 1)
373 return -EINVAL;
374
375 if (cpufreq_boost_trigger_state(enable)) {
Joe Perchese837f9b2014-03-11 10:03:00 -0700376 pr_err("%s: Cannot %s BOOST!\n",
377 __func__, enable ? "enable" : "disable");
Lukasz Majewski6f19efc2013-12-20 15:24:49 +0100378 return -EINVAL;
379 }
380
Joe Perchese837f9b2014-03-11 10:03:00 -0700381 pr_debug("%s: cpufreq BOOST %s\n",
382 __func__, enable ? "enabled" : "disabled");
Lukasz Majewski6f19efc2013-12-20 15:24:49 +0100383
384 return count;
385}
386define_one_global_rw(boost);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700387
Jeremy Fitzhardinge3bcb09a2006-07-06 12:30:26 -0700388static struct cpufreq_governor *__find_governor(const char *str_governor)
389{
390 struct cpufreq_governor *t;
391
392 list_for_each_entry(t, &cpufreq_governor_list, governor_list)
Dave Jones29464f22009-01-18 01:37:11 -0500393 if (!strnicmp(str_governor, t->name, CPUFREQ_NAME_LEN))
Jeremy Fitzhardinge3bcb09a2006-07-06 12:30:26 -0700394 return t;
395
396 return NULL;
397}
398
Linus Torvalds1da177e2005-04-16 15:20:36 -0700399/**
400 * cpufreq_parse_governor - parse a governor string
401 */
Dave Jones905d77c2008-03-05 14:28:32 -0500402static int cpufreq_parse_governor(char *str_governor, unsigned int *policy,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700403 struct cpufreq_governor **governor)
404{
Jeremy Fitzhardinge3bcb09a2006-07-06 12:30:26 -0700405 int err = -EINVAL;
406
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +0200407 if (!cpufreq_driver)
Jeremy Fitzhardinge3bcb09a2006-07-06 12:30:26 -0700408 goto out;
409
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +0200410 if (cpufreq_driver->setpolicy) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700411 if (!strnicmp(str_governor, "performance", CPUFREQ_NAME_LEN)) {
412 *policy = CPUFREQ_POLICY_PERFORMANCE;
Jeremy Fitzhardinge3bcb09a2006-07-06 12:30:26 -0700413 err = 0;
Gautham R Shenoye08f5f52006-10-26 16:20:58 +0530414 } else if (!strnicmp(str_governor, "powersave",
415 CPUFREQ_NAME_LEN)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700416 *policy = CPUFREQ_POLICY_POWERSAVE;
Jeremy Fitzhardinge3bcb09a2006-07-06 12:30:26 -0700417 err = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700418 }
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +0530419 } else if (has_target()) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700420 struct cpufreq_governor *t;
Jeremy Fitzhardinge3bcb09a2006-07-06 12:30:26 -0700421
akpm@osdl.org3fc54d32006-01-13 15:54:22 -0800422 mutex_lock(&cpufreq_governor_mutex);
Jeremy Fitzhardinge3bcb09a2006-07-06 12:30:26 -0700423
424 t = __find_governor(str_governor);
425
Jeremy Fitzhardingeea714972006-07-06 12:32:01 -0700426 if (t == NULL) {
Kees Cook1a8e1462011-05-04 08:38:56 -0700427 int ret;
Jeremy Fitzhardingeea714972006-07-06 12:32:01 -0700428
Kees Cook1a8e1462011-05-04 08:38:56 -0700429 mutex_unlock(&cpufreq_governor_mutex);
430 ret = request_module("cpufreq_%s", str_governor);
431 mutex_lock(&cpufreq_governor_mutex);
Jeremy Fitzhardingeea714972006-07-06 12:32:01 -0700432
Kees Cook1a8e1462011-05-04 08:38:56 -0700433 if (ret == 0)
434 t = __find_governor(str_governor);
Jeremy Fitzhardingeea714972006-07-06 12:32:01 -0700435 }
436
Jeremy Fitzhardinge3bcb09a2006-07-06 12:30:26 -0700437 if (t != NULL) {
438 *governor = t;
439 err = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700440 }
Jeremy Fitzhardinge3bcb09a2006-07-06 12:30:26 -0700441
akpm@osdl.org3fc54d32006-01-13 15:54:22 -0800442 mutex_unlock(&cpufreq_governor_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700443 }
Dave Jones29464f22009-01-18 01:37:11 -0500444out:
Jeremy Fitzhardinge3bcb09a2006-07-06 12:30:26 -0700445 return err;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700446}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700447
Linus Torvalds1da177e2005-04-16 15:20:36 -0700448/**
Gautham R Shenoye08f5f52006-10-26 16:20:58 +0530449 * cpufreq_per_cpu_attr_read() / show_##file_name() -
450 * print out cpufreq information
Linus Torvalds1da177e2005-04-16 15:20:36 -0700451 *
452 * Write out information from cpufreq_driver->policy[cpu]; object must be
453 * "unsigned int".
454 */
455
Dave Jones32ee8c32006-02-28 00:43:23 -0500456#define show_one(file_name, object) \
457static ssize_t show_##file_name \
Dave Jones905d77c2008-03-05 14:28:32 -0500458(struct cpufreq_policy *policy, char *buf) \
Dave Jones32ee8c32006-02-28 00:43:23 -0500459{ \
Dave Jones29464f22009-01-18 01:37:11 -0500460 return sprintf(buf, "%u\n", policy->object); \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700461}
462
463show_one(cpuinfo_min_freq, cpuinfo.min_freq);
464show_one(cpuinfo_max_freq, cpuinfo.max_freq);
Thomas Renningered129782009-02-04 01:17:41 +0100465show_one(cpuinfo_transition_latency, cpuinfo.transition_latency);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700466show_one(scaling_min_freq, min);
467show_one(scaling_max_freq, max);
468show_one(scaling_cur_freq, cur);
469
Viresh Kumar037ce832013-10-02 14:13:16 +0530470static int cpufreq_set_policy(struct cpufreq_policy *policy,
Viresh Kumar3a3e9e02013-08-06 22:53:05 +0530471 struct cpufreq_policy *new_policy);
Thomas Renninger7970e082006-04-13 15:14:04 +0200472
Linus Torvalds1da177e2005-04-16 15:20:36 -0700473/**
474 * cpufreq_per_cpu_attr_write() / store_##file_name() - sysfs write access
475 */
476#define store_one(file_name, object) \
477static ssize_t store_##file_name \
Dave Jones905d77c2008-03-05 14:28:32 -0500478(struct cpufreq_policy *policy, const char *buf, size_t count) \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700479{ \
Srivatsa S. Bhat5136fa52013-09-07 01:24:06 +0530480 int ret; \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700481 struct cpufreq_policy new_policy; \
482 \
483 ret = cpufreq_get_policy(&new_policy, policy->cpu); \
484 if (ret) \
485 return -EINVAL; \
486 \
Dave Jones29464f22009-01-18 01:37:11 -0500487 ret = sscanf(buf, "%u", &new_policy.object); \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700488 if (ret != 1) \
489 return -EINVAL; \
490 \
Viresh Kumar037ce832013-10-02 14:13:16 +0530491 ret = cpufreq_set_policy(policy, &new_policy); \
Thomas Renninger7970e082006-04-13 15:14:04 +0200492 policy->user_policy.object = policy->object; \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700493 \
494 return ret ? ret : count; \
495}
496
Dave Jones29464f22009-01-18 01:37:11 -0500497store_one(scaling_min_freq, min);
498store_one(scaling_max_freq, max);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700499
500/**
501 * show_cpuinfo_cur_freq - current CPU frequency as detected by hardware
502 */
Dave Jones905d77c2008-03-05 14:28:32 -0500503static ssize_t show_cpuinfo_cur_freq(struct cpufreq_policy *policy,
504 char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700505{
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -0800506 unsigned int cur_freq = __cpufreq_get(policy->cpu);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700507 if (!cur_freq)
508 return sprintf(buf, "<unknown>");
509 return sprintf(buf, "%u\n", cur_freq);
510}
511
Linus Torvalds1da177e2005-04-16 15:20:36 -0700512/**
513 * show_scaling_governor - show the current policy for the specified CPU
514 */
Dave Jones905d77c2008-03-05 14:28:32 -0500515static ssize_t show_scaling_governor(struct cpufreq_policy *policy, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700516{
Dave Jones29464f22009-01-18 01:37:11 -0500517 if (policy->policy == CPUFREQ_POLICY_POWERSAVE)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700518 return sprintf(buf, "powersave\n");
519 else if (policy->policy == CPUFREQ_POLICY_PERFORMANCE)
520 return sprintf(buf, "performance\n");
521 else if (policy->governor)
viresh kumar4b972f02012-10-23 01:23:43 +0200522 return scnprintf(buf, CPUFREQ_NAME_PLEN, "%s\n",
Dave Jones29464f22009-01-18 01:37:11 -0500523 policy->governor->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700524 return -EINVAL;
525}
526
Linus Torvalds1da177e2005-04-16 15:20:36 -0700527/**
528 * store_scaling_governor - store policy for the specified CPU
529 */
Dave Jones905d77c2008-03-05 14:28:32 -0500530static ssize_t store_scaling_governor(struct cpufreq_policy *policy,
531 const char *buf, size_t count)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700532{
Srivatsa S. Bhat5136fa52013-09-07 01:24:06 +0530533 int ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700534 char str_governor[16];
535 struct cpufreq_policy new_policy;
536
537 ret = cpufreq_get_policy(&new_policy, policy->cpu);
538 if (ret)
539 return ret;
540
Dave Jones29464f22009-01-18 01:37:11 -0500541 ret = sscanf(buf, "%15s", str_governor);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700542 if (ret != 1)
543 return -EINVAL;
544
Gautham R Shenoye08f5f52006-10-26 16:20:58 +0530545 if (cpufreq_parse_governor(str_governor, &new_policy.policy,
546 &new_policy.governor))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700547 return -EINVAL;
548
Viresh Kumar037ce832013-10-02 14:13:16 +0530549 ret = cpufreq_set_policy(policy, &new_policy);
Thomas Renninger7970e082006-04-13 15:14:04 +0200550
551 policy->user_policy.policy = policy->policy;
552 policy->user_policy.governor = policy->governor;
Thomas Renninger7970e082006-04-13 15:14:04 +0200553
Gautham R Shenoye08f5f52006-10-26 16:20:58 +0530554 if (ret)
555 return ret;
556 else
557 return count;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700558}
559
560/**
561 * show_scaling_driver - show the cpufreq driver currently loaded
562 */
Dave Jones905d77c2008-03-05 14:28:32 -0500563static ssize_t show_scaling_driver(struct cpufreq_policy *policy, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700564{
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +0200565 return scnprintf(buf, CPUFREQ_NAME_PLEN, "%s\n", cpufreq_driver->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700566}
567
568/**
569 * show_scaling_available_governors - show the available CPUfreq governors
570 */
Dave Jones905d77c2008-03-05 14:28:32 -0500571static ssize_t show_scaling_available_governors(struct cpufreq_policy *policy,
572 char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700573{
574 ssize_t i = 0;
575 struct cpufreq_governor *t;
576
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +0530577 if (!has_target()) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700578 i += sprintf(buf, "performance powersave");
579 goto out;
580 }
581
582 list_for_each_entry(t, &cpufreq_governor_list, governor_list) {
Dave Jones29464f22009-01-18 01:37:11 -0500583 if (i >= (ssize_t) ((PAGE_SIZE / sizeof(char))
584 - (CPUFREQ_NAME_LEN + 2)))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700585 goto out;
viresh kumar4b972f02012-10-23 01:23:43 +0200586 i += scnprintf(&buf[i], CPUFREQ_NAME_PLEN, "%s ", t->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700587 }
Dave Jones7d5e3502006-02-02 17:03:42 -0500588out:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700589 i += sprintf(&buf[i], "\n");
590 return i;
591}
Darrick J. Wonge8628dd2008-04-18 13:31:12 -0700592
Lan Tianyuf4fd3792013-06-27 15:08:54 +0800593ssize_t cpufreq_show_cpus(const struct cpumask *mask, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700594{
595 ssize_t i = 0;
596 unsigned int cpu;
597
Rusty Russell835481d2009-01-04 05:18:06 -0800598 for_each_cpu(cpu, mask) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700599 if (i)
600 i += scnprintf(&buf[i], (PAGE_SIZE - i - 2), " ");
601 i += scnprintf(&buf[i], (PAGE_SIZE - i - 2), "%u", cpu);
602 if (i >= (PAGE_SIZE - 5))
Dave Jones29464f22009-01-18 01:37:11 -0500603 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700604 }
605 i += sprintf(&buf[i], "\n");
606 return i;
607}
Lan Tianyuf4fd3792013-06-27 15:08:54 +0800608EXPORT_SYMBOL_GPL(cpufreq_show_cpus);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700609
Darrick J. Wonge8628dd2008-04-18 13:31:12 -0700610/**
611 * show_related_cpus - show the CPUs affected by each transition even if
612 * hw coordination is in use
613 */
614static ssize_t show_related_cpus(struct cpufreq_policy *policy, char *buf)
615{
Lan Tianyuf4fd3792013-06-27 15:08:54 +0800616 return cpufreq_show_cpus(policy->related_cpus, buf);
Darrick J. Wonge8628dd2008-04-18 13:31:12 -0700617}
618
619/**
620 * show_affected_cpus - show the CPUs affected by each transition
621 */
622static ssize_t show_affected_cpus(struct cpufreq_policy *policy, char *buf)
623{
Lan Tianyuf4fd3792013-06-27 15:08:54 +0800624 return cpufreq_show_cpus(policy->cpus, buf);
Darrick J. Wonge8628dd2008-04-18 13:31:12 -0700625}
626
Venki Pallipadi9e769882007-10-26 10:18:21 -0700627static ssize_t store_scaling_setspeed(struct cpufreq_policy *policy,
Dave Jones905d77c2008-03-05 14:28:32 -0500628 const char *buf, size_t count)
Venki Pallipadi9e769882007-10-26 10:18:21 -0700629{
630 unsigned int freq = 0;
631 unsigned int ret;
632
CHIKAMA masaki879000f2008-06-05 22:46:33 -0700633 if (!policy->governor || !policy->governor->store_setspeed)
Venki Pallipadi9e769882007-10-26 10:18:21 -0700634 return -EINVAL;
635
636 ret = sscanf(buf, "%u", &freq);
637 if (ret != 1)
638 return -EINVAL;
639
640 policy->governor->store_setspeed(policy, freq);
641
642 return count;
643}
644
645static ssize_t show_scaling_setspeed(struct cpufreq_policy *policy, char *buf)
646{
CHIKAMA masaki879000f2008-06-05 22:46:33 -0700647 if (!policy->governor || !policy->governor->show_setspeed)
Venki Pallipadi9e769882007-10-26 10:18:21 -0700648 return sprintf(buf, "<unsupported>\n");
649
650 return policy->governor->show_setspeed(policy, buf);
651}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700652
Thomas Renningere2f74f32009-11-19 12:31:01 +0100653/**
viresh kumar8bf1ac722012-10-23 01:23:33 +0200654 * show_bios_limit - show the current cpufreq HW/BIOS limitation
Thomas Renningere2f74f32009-11-19 12:31:01 +0100655 */
656static ssize_t show_bios_limit(struct cpufreq_policy *policy, char *buf)
657{
658 unsigned int limit;
659 int ret;
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +0200660 if (cpufreq_driver->bios_limit) {
661 ret = cpufreq_driver->bios_limit(policy->cpu, &limit);
Thomas Renningere2f74f32009-11-19 12:31:01 +0100662 if (!ret)
663 return sprintf(buf, "%u\n", limit);
664 }
665 return sprintf(buf, "%u\n", policy->cpuinfo.max_freq);
666}
667
Borislav Petkov6dad2a22010-03-31 21:56:46 +0200668cpufreq_freq_attr_ro_perm(cpuinfo_cur_freq, 0400);
669cpufreq_freq_attr_ro(cpuinfo_min_freq);
670cpufreq_freq_attr_ro(cpuinfo_max_freq);
671cpufreq_freq_attr_ro(cpuinfo_transition_latency);
672cpufreq_freq_attr_ro(scaling_available_governors);
673cpufreq_freq_attr_ro(scaling_driver);
674cpufreq_freq_attr_ro(scaling_cur_freq);
675cpufreq_freq_attr_ro(bios_limit);
676cpufreq_freq_attr_ro(related_cpus);
677cpufreq_freq_attr_ro(affected_cpus);
678cpufreq_freq_attr_rw(scaling_min_freq);
679cpufreq_freq_attr_rw(scaling_max_freq);
680cpufreq_freq_attr_rw(scaling_governor);
681cpufreq_freq_attr_rw(scaling_setspeed);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700682
Dave Jones905d77c2008-03-05 14:28:32 -0500683static struct attribute *default_attrs[] = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700684 &cpuinfo_min_freq.attr,
685 &cpuinfo_max_freq.attr,
Thomas Renningered129782009-02-04 01:17:41 +0100686 &cpuinfo_transition_latency.attr,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700687 &scaling_min_freq.attr,
688 &scaling_max_freq.attr,
689 &affected_cpus.attr,
Darrick J. Wonge8628dd2008-04-18 13:31:12 -0700690 &related_cpus.attr,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700691 &scaling_governor.attr,
692 &scaling_driver.attr,
693 &scaling_available_governors.attr,
Venki Pallipadi9e769882007-10-26 10:18:21 -0700694 &scaling_setspeed.attr,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700695 NULL
696};
697
Dave Jones29464f22009-01-18 01:37:11 -0500698#define to_policy(k) container_of(k, struct cpufreq_policy, kobj)
699#define to_attr(a) container_of(a, struct freq_attr, attr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700700
Dave Jones29464f22009-01-18 01:37:11 -0500701static ssize_t show(struct kobject *kobj, struct attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700702{
Dave Jones905d77c2008-03-05 14:28:32 -0500703 struct cpufreq_policy *policy = to_policy(kobj);
704 struct freq_attr *fattr = to_attr(attr);
Viresh Kumar1b750e32013-10-02 14:13:09 +0530705 ssize_t ret;
Viresh Kumar6eed9402013-08-06 22:53:11 +0530706
707 if (!down_read_trylock(&cpufreq_rwsem))
Viresh Kumar1b750e32013-10-02 14:13:09 +0530708 return -EINVAL;
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -0800709
viresh kumarad7722d2013-10-18 19:10:15 +0530710 down_read(&policy->rwsem);
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -0800711
Gautham R Shenoye08f5f52006-10-26 16:20:58 +0530712 if (fattr->show)
713 ret = fattr->show(policy, buf);
714 else
715 ret = -EIO;
716
viresh kumarad7722d2013-10-18 19:10:15 +0530717 up_read(&policy->rwsem);
Viresh Kumar6eed9402013-08-06 22:53:11 +0530718 up_read(&cpufreq_rwsem);
Viresh Kumar1b750e32013-10-02 14:13:09 +0530719
Linus Torvalds1da177e2005-04-16 15:20:36 -0700720 return ret;
721}
722
Dave Jones905d77c2008-03-05 14:28:32 -0500723static ssize_t store(struct kobject *kobj, struct attribute *attr,
724 const char *buf, size_t count)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700725{
Dave Jones905d77c2008-03-05 14:28:32 -0500726 struct cpufreq_policy *policy = to_policy(kobj);
727 struct freq_attr *fattr = to_attr(attr);
Dave Jonesa07530b2008-03-05 14:22:25 -0500728 ssize_t ret = -EINVAL;
Viresh Kumar6eed9402013-08-06 22:53:11 +0530729
Srivatsa S. Bhat4f750c92013-09-07 01:23:43 +0530730 get_online_cpus();
731
732 if (!cpu_online(policy->cpu))
733 goto unlock;
734
Viresh Kumar6eed9402013-08-06 22:53:11 +0530735 if (!down_read_trylock(&cpufreq_rwsem))
Srivatsa S. Bhat4f750c92013-09-07 01:23:43 +0530736 goto unlock;
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -0800737
viresh kumarad7722d2013-10-18 19:10:15 +0530738 down_write(&policy->rwsem);
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -0800739
Gautham R Shenoye08f5f52006-10-26 16:20:58 +0530740 if (fattr->store)
741 ret = fattr->store(policy, buf, count);
742 else
743 ret = -EIO;
744
viresh kumarad7722d2013-10-18 19:10:15 +0530745 up_write(&policy->rwsem);
Viresh Kumar6eed9402013-08-06 22:53:11 +0530746
Viresh Kumar6eed9402013-08-06 22:53:11 +0530747 up_read(&cpufreq_rwsem);
Srivatsa S. Bhat4f750c92013-09-07 01:23:43 +0530748unlock:
749 put_online_cpus();
750
Linus Torvalds1da177e2005-04-16 15:20:36 -0700751 return ret;
752}
753
Dave Jones905d77c2008-03-05 14:28:32 -0500754static void cpufreq_sysfs_release(struct kobject *kobj)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700755{
Dave Jones905d77c2008-03-05 14:28:32 -0500756 struct cpufreq_policy *policy = to_policy(kobj);
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +0200757 pr_debug("last reference is dropped\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700758 complete(&policy->kobj_unregister);
759}
760
Emese Revfy52cf25d2010-01-19 02:58:23 +0100761static const struct sysfs_ops sysfs_ops = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700762 .show = show,
763 .store = store,
764};
765
766static struct kobj_type ktype_cpufreq = {
767 .sysfs_ops = &sysfs_ops,
768 .default_attrs = default_attrs,
769 .release = cpufreq_sysfs_release,
770};
771
Viresh Kumar2361be22013-05-17 16:09:09 +0530772struct kobject *cpufreq_global_kobject;
773EXPORT_SYMBOL(cpufreq_global_kobject);
774
775static int cpufreq_global_kobject_usage;
776
777int cpufreq_get_global_kobject(void)
778{
779 if (!cpufreq_global_kobject_usage++)
780 return kobject_add(cpufreq_global_kobject,
781 &cpu_subsys.dev_root->kobj, "%s", "cpufreq");
782
783 return 0;
784}
785EXPORT_SYMBOL(cpufreq_get_global_kobject);
786
787void cpufreq_put_global_kobject(void)
788{
789 if (!--cpufreq_global_kobject_usage)
790 kobject_del(cpufreq_global_kobject);
791}
792EXPORT_SYMBOL(cpufreq_put_global_kobject);
793
794int cpufreq_sysfs_create_file(const struct attribute *attr)
795{
796 int ret = cpufreq_get_global_kobject();
797
798 if (!ret) {
799 ret = sysfs_create_file(cpufreq_global_kobject, attr);
800 if (ret)
801 cpufreq_put_global_kobject();
802 }
803
804 return ret;
805}
806EXPORT_SYMBOL(cpufreq_sysfs_create_file);
807
808void cpufreq_sysfs_remove_file(const struct attribute *attr)
809{
810 sysfs_remove_file(cpufreq_global_kobject, attr);
811 cpufreq_put_global_kobject();
812}
813EXPORT_SYMBOL(cpufreq_sysfs_remove_file);
814
Dave Jones19d6f7e2009-07-08 17:35:39 -0400815/* symlink affected CPUs */
Viresh Kumar308b60e2013-07-31 14:35:14 +0200816static int cpufreq_add_dev_symlink(struct cpufreq_policy *policy)
Dave Jones19d6f7e2009-07-08 17:35:39 -0400817{
818 unsigned int j;
819 int ret = 0;
820
821 for_each_cpu(j, policy->cpus) {
Kay Sievers8a25a2f2011-12-21 14:29:42 -0800822 struct device *cpu_dev;
Dave Jones19d6f7e2009-07-08 17:35:39 -0400823
Viresh Kumar308b60e2013-07-31 14:35:14 +0200824 if (j == policy->cpu)
Dave Jones19d6f7e2009-07-08 17:35:39 -0400825 continue;
Dave Jones19d6f7e2009-07-08 17:35:39 -0400826
Viresh Kumare8fdde12013-07-31 14:31:33 +0200827 pr_debug("Adding link for CPU: %u\n", j);
Kay Sievers8a25a2f2011-12-21 14:29:42 -0800828 cpu_dev = get_cpu_device(j);
829 ret = sysfs_create_link(&cpu_dev->kobj, &policy->kobj,
Dave Jones19d6f7e2009-07-08 17:35:39 -0400830 "cpufreq");
Rafael J. Wysocki71c34612013-08-04 01:19:34 +0200831 if (ret)
832 break;
Dave Jones19d6f7e2009-07-08 17:35:39 -0400833 }
834 return ret;
835}
836
Viresh Kumar308b60e2013-07-31 14:35:14 +0200837static int cpufreq_add_dev_interface(struct cpufreq_policy *policy,
Kay Sievers8a25a2f2011-12-21 14:29:42 -0800838 struct device *dev)
Dave Jones909a6942009-07-08 18:05:42 -0400839{
840 struct freq_attr **drv_attr;
Dave Jones909a6942009-07-08 18:05:42 -0400841 int ret = 0;
Dave Jones909a6942009-07-08 18:05:42 -0400842
843 /* prepare interface data */
844 ret = kobject_init_and_add(&policy->kobj, &ktype_cpufreq,
Kay Sievers8a25a2f2011-12-21 14:29:42 -0800845 &dev->kobj, "cpufreq");
Dave Jones909a6942009-07-08 18:05:42 -0400846 if (ret)
847 return ret;
848
849 /* set up files for this cpu device */
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +0200850 drv_attr = cpufreq_driver->attr;
Dave Jones909a6942009-07-08 18:05:42 -0400851 while ((drv_attr) && (*drv_attr)) {
852 ret = sysfs_create_file(&policy->kobj, &((*drv_attr)->attr));
853 if (ret)
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +0200854 goto err_out_kobj_put;
Dave Jones909a6942009-07-08 18:05:42 -0400855 drv_attr++;
856 }
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +0200857 if (cpufreq_driver->get) {
Dave Jones909a6942009-07-08 18:05:42 -0400858 ret = sysfs_create_file(&policy->kobj, &cpuinfo_cur_freq.attr);
859 if (ret)
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +0200860 goto err_out_kobj_put;
Dave Jones909a6942009-07-08 18:05:42 -0400861 }
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +0530862 if (has_target()) {
Dave Jones909a6942009-07-08 18:05:42 -0400863 ret = sysfs_create_file(&policy->kobj, &scaling_cur_freq.attr);
864 if (ret)
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +0200865 goto err_out_kobj_put;
Dave Jones909a6942009-07-08 18:05:42 -0400866 }
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +0200867 if (cpufreq_driver->bios_limit) {
Thomas Renningere2f74f32009-11-19 12:31:01 +0100868 ret = sysfs_create_file(&policy->kobj, &bios_limit.attr);
869 if (ret)
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +0200870 goto err_out_kobj_put;
Thomas Renningere2f74f32009-11-19 12:31:01 +0100871 }
Dave Jones909a6942009-07-08 18:05:42 -0400872
Viresh Kumar308b60e2013-07-31 14:35:14 +0200873 ret = cpufreq_add_dev_symlink(policy);
Dave Jonesecf7e462009-07-08 18:48:47 -0400874 if (ret)
875 goto err_out_kobj_put;
876
Srivatsa S. Bhate18f1682013-07-30 04:24:23 +0530877 return ret;
878
879err_out_kobj_put:
880 kobject_put(&policy->kobj);
881 wait_for_completion(&policy->kobj_unregister);
882 return ret;
883}
884
885static void cpufreq_init_policy(struct cpufreq_policy *policy)
886{
viresh kumar6e2c89d2014-03-04 11:43:59 +0800887 struct cpufreq_governor *gov = NULL;
Srivatsa S. Bhate18f1682013-07-30 04:24:23 +0530888 struct cpufreq_policy new_policy;
889 int ret = 0;
890
Viresh Kumard5b73cd2013-08-06 22:53:06 +0530891 memcpy(&new_policy, policy, sizeof(*policy));
Jason Barona27a9ab2013-12-19 22:50:50 +0000892
viresh kumar6e2c89d2014-03-04 11:43:59 +0800893 /* Update governor of new_policy to the governor used before hotplug */
894 gov = __find_governor(per_cpu(cpufreq_cpu_governor, policy->cpu));
895 if (gov)
896 pr_debug("Restoring governor %s for cpu %d\n",
897 policy->governor->name, policy->cpu);
898 else
899 gov = CPUFREQ_DEFAULT_GOVERNOR;
900
901 new_policy.governor = gov;
902
Jason Barona27a9ab2013-12-19 22:50:50 +0000903 /* Use the default policy if its valid. */
904 if (cpufreq_driver->setpolicy)
viresh kumar6e2c89d2014-03-04 11:43:59 +0800905 cpufreq_parse_governor(gov->name, &new_policy.policy, NULL);
Dave Jonesecf7e462009-07-08 18:48:47 -0400906
907 /* set default policy */
Viresh Kumar037ce832013-10-02 14:13:16 +0530908 ret = cpufreq_set_policy(policy, &new_policy);
Dave Jonesecf7e462009-07-08 18:48:47 -0400909 if (ret) {
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +0200910 pr_debug("setting policy failed\n");
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +0200911 if (cpufreq_driver->exit)
912 cpufreq_driver->exit(policy);
Dave Jonesecf7e462009-07-08 18:48:47 -0400913 }
Dave Jones909a6942009-07-08 18:05:42 -0400914}
915
Viresh Kumarfcf80582013-01-29 14:39:08 +0000916#ifdef CONFIG_HOTPLUG_CPU
Viresh Kumard8d3b472013-08-04 01:20:07 +0200917static int cpufreq_add_policy_cpu(struct cpufreq_policy *policy,
Viresh Kumar42f921a2013-12-20 21:26:02 +0530918 unsigned int cpu, struct device *dev)
Viresh Kumarfcf80582013-01-29 14:39:08 +0000919{
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +0530920 int ret = 0;
Viresh Kumarfcf80582013-01-29 14:39:08 +0000921 unsigned long flags;
922
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +0530923 if (has_target()) {
Viresh Kumar3de9bde2013-08-06 22:53:13 +0530924 ret = __cpufreq_governor(policy, CPUFREQ_GOV_STOP);
925 if (ret) {
926 pr_err("%s: Failed to stop governor\n", __func__);
927 return ret;
928 }
929 }
Viresh Kumarfcf80582013-01-29 14:39:08 +0000930
viresh kumarad7722d2013-10-18 19:10:15 +0530931 down_write(&policy->rwsem);
Viresh Kumar2eaa3e22013-02-07 10:55:00 +0530932
Nathan Zimmer0d1857a2013-02-22 16:24:34 +0000933 write_lock_irqsave(&cpufreq_driver_lock, flags);
Viresh Kumar2eaa3e22013-02-07 10:55:00 +0530934
Viresh Kumarfcf80582013-01-29 14:39:08 +0000935 cpumask_set_cpu(cpu, policy->cpus);
936 per_cpu(cpufreq_cpu_data, cpu) = policy;
Nathan Zimmer0d1857a2013-02-22 16:24:34 +0000937 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
Viresh Kumarfcf80582013-01-29 14:39:08 +0000938
viresh kumarad7722d2013-10-18 19:10:15 +0530939 up_write(&policy->rwsem);
Viresh Kumar2eaa3e22013-02-07 10:55:00 +0530940
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +0530941 if (has_target()) {
Stratos Karafotise5c87b72014-03-19 23:29:17 +0200942 ret = __cpufreq_governor(policy, CPUFREQ_GOV_START);
943 if (!ret)
944 ret = __cpufreq_governor(policy, CPUFREQ_GOV_LIMITS);
945
946 if (ret) {
Viresh Kumar3de9bde2013-08-06 22:53:13 +0530947 pr_err("%s: Failed to start governor\n", __func__);
948 return ret;
949 }
Viresh Kumar820c6ca2013-04-22 00:48:03 +0200950 }
Viresh Kumarfcf80582013-01-29 14:39:08 +0000951
Viresh Kumar42f921a2013-12-20 21:26:02 +0530952 return sysfs_create_link(&dev->kobj, &policy->kobj, "cpufreq");
Viresh Kumarfcf80582013-01-29 14:39:08 +0000953}
954#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700955
Srivatsa S. Bhat84148092013-07-30 04:25:10 +0530956static struct cpufreq_policy *cpufreq_policy_restore(unsigned int cpu)
957{
958 struct cpufreq_policy *policy;
959 unsigned long flags;
960
Lan Tianyu44871c92013-09-11 15:05:05 +0800961 read_lock_irqsave(&cpufreq_driver_lock, flags);
Srivatsa S. Bhat84148092013-07-30 04:25:10 +0530962
963 policy = per_cpu(cpufreq_cpu_data_fallback, cpu);
964
Lan Tianyu44871c92013-09-11 15:05:05 +0800965 read_unlock_irqrestore(&cpufreq_driver_lock, flags);
Srivatsa S. Bhat84148092013-07-30 04:25:10 +0530966
viresh kumar6e2c89d2014-03-04 11:43:59 +0800967 policy->governor = NULL;
968
Srivatsa S. Bhat84148092013-07-30 04:25:10 +0530969 return policy;
970}
971
Srivatsa S. Bhate9698cc2013-07-30 04:24:11 +0530972static struct cpufreq_policy *cpufreq_policy_alloc(void)
973{
974 struct cpufreq_policy *policy;
975
976 policy = kzalloc(sizeof(*policy), GFP_KERNEL);
977 if (!policy)
978 return NULL;
979
980 if (!alloc_cpumask_var(&policy->cpus, GFP_KERNEL))
981 goto err_free_policy;
982
983 if (!zalloc_cpumask_var(&policy->related_cpus, GFP_KERNEL))
984 goto err_free_cpumask;
985
Lukasz Majewskic88a1f82013-08-06 22:53:08 +0530986 INIT_LIST_HEAD(&policy->policy_list);
viresh kumarad7722d2013-10-18 19:10:15 +0530987 init_rwsem(&policy->rwsem);
988
Srivatsa S. Bhate9698cc2013-07-30 04:24:11 +0530989 return policy;
990
991err_free_cpumask:
992 free_cpumask_var(policy->cpus);
993err_free_policy:
994 kfree(policy);
995
996 return NULL;
997}
998
Viresh Kumar42f921a2013-12-20 21:26:02 +0530999static void cpufreq_policy_put_kobj(struct cpufreq_policy *policy)
1000{
1001 struct kobject *kobj;
1002 struct completion *cmp;
1003
Viresh Kumarfcd7af92014-01-07 07:10:10 +05301004 blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
1005 CPUFREQ_REMOVE_POLICY, policy);
1006
Viresh Kumar42f921a2013-12-20 21:26:02 +05301007 down_read(&policy->rwsem);
1008 kobj = &policy->kobj;
1009 cmp = &policy->kobj_unregister;
1010 up_read(&policy->rwsem);
1011 kobject_put(kobj);
1012
1013 /*
1014 * We need to make sure that the underlying kobj is
1015 * actually not referenced anymore by anybody before we
1016 * proceed with unloading.
1017 */
1018 pr_debug("waiting for dropping of refcount\n");
1019 wait_for_completion(cmp);
1020 pr_debug("wait complete\n");
1021}
1022
Srivatsa S. Bhate9698cc2013-07-30 04:24:11 +05301023static void cpufreq_policy_free(struct cpufreq_policy *policy)
1024{
1025 free_cpumask_var(policy->related_cpus);
1026 free_cpumask_var(policy->cpus);
1027 kfree(policy);
1028}
1029
Srivatsa S. Bhat0d66b912013-09-12 01:42:59 +05301030static void update_policy_cpu(struct cpufreq_policy *policy, unsigned int cpu)
1031{
Srivatsa S. Bhat99ec8992013-09-12 17:29:09 +05301032 if (WARN_ON(cpu == policy->cpu))
Srivatsa S. Bhatcb38ed52013-09-12 01:43:42 +05301033 return;
1034
viresh kumarad7722d2013-10-18 19:10:15 +05301035 down_write(&policy->rwsem);
Viresh Kumar8efd5762013-09-17 10:22:11 +05301036
Srivatsa S. Bhat0d66b912013-09-12 01:42:59 +05301037 policy->last_cpu = policy->cpu;
1038 policy->cpu = cpu;
1039
viresh kumarad7722d2013-10-18 19:10:15 +05301040 up_write(&policy->rwsem);
Viresh Kumar8efd5762013-09-17 10:22:11 +05301041
Srivatsa S. Bhat0d66b912013-09-12 01:42:59 +05301042 blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
1043 CPUFREQ_UPDATE_POLICY_CPU, policy);
1044}
1045
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301046static int __cpufreq_add_dev(struct device *dev, struct subsys_interface *sif)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001047{
Viresh Kumarfcf80582013-01-29 14:39:08 +00001048 unsigned int j, cpu = dev->id;
Viresh Kumar65922462013-02-07 10:56:03 +05301049 int ret = -ENOMEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001050 struct cpufreq_policy *policy;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001051 unsigned long flags;
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301052 bool recover_policy = cpufreq_suspended;
Prarit Bhargava90e41ba2009-11-12 09:18:46 -05001053#ifdef CONFIG_HOTPLUG_CPU
Viresh Kumar1b274292013-08-20 12:08:26 +05301054 struct cpufreq_policy *tpolicy;
Prarit Bhargava90e41ba2009-11-12 09:18:46 -05001055#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07001056
Ashok Rajc32b6b82005-10-30 14:59:54 -08001057 if (cpu_is_offline(cpu))
1058 return 0;
1059
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02001060 pr_debug("adding CPU %u\n", cpu);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001061
1062#ifdef CONFIG_SMP
1063 /* check whether a different CPU already registered this
1064 * CPU because it is in the same boat. */
1065 policy = cpufreq_cpu_get(cpu);
1066 if (unlikely(policy)) {
Dave Jones8ff69732006-03-05 03:37:23 -05001067 cpufreq_cpu_put(policy);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001068 return 0;
1069 }
Li Zhong5025d622013-08-21 01:31:08 +02001070#endif
Viresh Kumarfcf80582013-01-29 14:39:08 +00001071
Viresh Kumar6eed9402013-08-06 22:53:11 +05301072 if (!down_read_trylock(&cpufreq_rwsem))
1073 return 0;
1074
Viresh Kumarfcf80582013-01-29 14:39:08 +00001075#ifdef CONFIG_HOTPLUG_CPU
1076 /* Check if this cpu was hot-unplugged earlier and has siblings */
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00001077 read_lock_irqsave(&cpufreq_driver_lock, flags);
Viresh Kumar1b274292013-08-20 12:08:26 +05301078 list_for_each_entry(tpolicy, &cpufreq_policy_list, policy_list) {
1079 if (cpumask_test_cpu(cpu, tpolicy->related_cpus)) {
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00001080 read_unlock_irqrestore(&cpufreq_driver_lock, flags);
Viresh Kumar42f921a2013-12-20 21:26:02 +05301081 ret = cpufreq_add_policy_cpu(tpolicy, cpu, dev);
Viresh Kumar6eed9402013-08-06 22:53:11 +05301082 up_read(&cpufreq_rwsem);
1083 return ret;
Viresh Kumar2eaa3e22013-02-07 10:55:00 +05301084 }
Viresh Kumarfcf80582013-01-29 14:39:08 +00001085 }
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00001086 read_unlock_irqrestore(&cpufreq_driver_lock, flags);
Viresh Kumarfcf80582013-01-29 14:39:08 +00001087#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07001088
Rafael J. Wysocki72368d12013-12-27 01:07:11 +01001089 /*
1090 * Restore the saved policy when doing light-weight init and fall back
1091 * to the full init if that fails.
1092 */
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301093 policy = recover_policy ? cpufreq_policy_restore(cpu) : NULL;
Rafael J. Wysocki72368d12013-12-27 01:07:11 +01001094 if (!policy) {
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301095 recover_policy = false;
Srivatsa S. Bhat84148092013-07-30 04:25:10 +05301096 policy = cpufreq_policy_alloc();
Rafael J. Wysocki72368d12013-12-27 01:07:11 +01001097 if (!policy)
1098 goto nomem_out;
1099 }
Srivatsa S. Bhat0d66b912013-09-12 01:42:59 +05301100
1101 /*
1102 * In the resume path, since we restore a saved policy, the assignment
1103 * to policy->cpu is like an update of the existing policy, rather than
1104 * the creation of a brand new one. So we need to perform this update
1105 * by invoking update_policy_cpu().
1106 */
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301107 if (recover_policy && cpu != policy->cpu)
Srivatsa S. Bhat0d66b912013-09-12 01:42:59 +05301108 update_policy_cpu(policy, cpu);
1109 else
1110 policy->cpu = cpu;
1111
Rusty Russell835481d2009-01-04 05:18:06 -08001112 cpumask_copy(policy->cpus, cpumask_of(cpu));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001113
Linus Torvalds1da177e2005-04-16 15:20:36 -07001114 init_completion(&policy->kobj_unregister);
David Howells65f27f32006-11-22 14:55:48 +00001115 INIT_WORK(&policy->update, handle_update);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001116
1117 /* call driver. From then on the cpufreq must be able
1118 * to accept all calls to ->verify and ->setpolicy for this CPU
1119 */
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02001120 ret = cpufreq_driver->init(policy);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001121 if (ret) {
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02001122 pr_debug("initialization failed\n");
Viresh Kumar2eaa3e22013-02-07 10:55:00 +05301123 goto err_set_policy_cpu;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001124 }
Viresh Kumar643ae6e2013-01-12 05:14:38 +00001125
Viresh Kumar5a7e56a2014-03-04 11:44:00 +08001126 /* related cpus should atleast have policy->cpus */
1127 cpumask_or(policy->related_cpus, policy->related_cpus, policy->cpus);
1128
1129 /*
1130 * affected cpus must always be the one, which are online. We aren't
1131 * managing offline cpus here.
1132 */
1133 cpumask_and(policy->cpus, policy->cpus, cpu_online_mask);
1134
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301135 if (!recover_policy) {
Viresh Kumar5a7e56a2014-03-04 11:44:00 +08001136 policy->user_policy.min = policy->min;
1137 policy->user_policy.max = policy->max;
1138 }
1139
Viresh Kumar4e97b632014-03-04 11:44:01 +08001140 down_write(&policy->rwsem);
Viresh Kumar652ed952014-01-09 20:38:43 +05301141 write_lock_irqsave(&cpufreq_driver_lock, flags);
1142 for_each_cpu(j, policy->cpus)
1143 per_cpu(cpufreq_cpu_data, j) = policy;
1144 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
1145
Rafael J. Wysocki2ed99e32014-03-12 21:49:33 +01001146 if (cpufreq_driver->get && !cpufreq_driver->setpolicy) {
Viresh Kumarda60ce92013-10-03 20:28:30 +05301147 policy->cur = cpufreq_driver->get(policy->cpu);
1148 if (!policy->cur) {
1149 pr_err("%s: ->get() failed\n", __func__);
1150 goto err_get_freq;
1151 }
1152 }
1153
Viresh Kumard3916692013-12-03 11:20:46 +05301154 /*
1155 * Sometimes boot loaders set CPU frequency to a value outside of
1156 * frequency table present with cpufreq core. In such cases CPU might be
1157 * unstable if it has to run on that frequency for long duration of time
1158 * and so its better to set it to a frequency which is specified in
1159 * freq-table. This also makes cpufreq stats inconsistent as
1160 * cpufreq-stats would fail to register because current frequency of CPU
1161 * isn't found in freq-table.
1162 *
1163 * Because we don't want this change to effect boot process badly, we go
1164 * for the next freq which is >= policy->cur ('cur' must be set by now,
1165 * otherwise we will end up setting freq to lowest of the table as 'cur'
1166 * is initialized to zero).
1167 *
1168 * We are passing target-freq as "policy->cur - 1" otherwise
1169 * __cpufreq_driver_target() would simply fail, as policy->cur will be
1170 * equal to target-freq.
1171 */
1172 if ((cpufreq_driver->flags & CPUFREQ_NEED_INITIAL_FREQ_CHECK)
1173 && has_target()) {
1174 /* Are we running at unknown frequency ? */
1175 ret = cpufreq_frequency_table_get_index(policy, policy->cur);
1176 if (ret == -EINVAL) {
1177 /* Warn user and fix it */
1178 pr_warn("%s: CPU%d: Running at unlisted freq: %u KHz\n",
1179 __func__, policy->cpu, policy->cur);
1180 ret = __cpufreq_driver_target(policy, policy->cur - 1,
1181 CPUFREQ_RELATION_L);
1182
1183 /*
1184 * Reaching here after boot in a few seconds may not
1185 * mean that system will remain stable at "unknown"
1186 * frequency for longer duration. Hence, a BUG_ON().
1187 */
1188 BUG_ON(ret);
1189 pr_warn("%s: CPU%d: Unlisted initial frequency changed to: %u KHz\n",
1190 __func__, policy->cpu, policy->cur);
1191 }
1192 }
1193
Thomas Renningera1531ac2008-07-29 22:32:58 -07001194 blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
1195 CPUFREQ_START, policy);
1196
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301197 if (!recover_policy) {
Viresh Kumar308b60e2013-07-31 14:35:14 +02001198 ret = cpufreq_add_dev_interface(policy, dev);
Srivatsa S. Bhata82fab22013-07-30 04:24:49 +05301199 if (ret)
1200 goto err_out_unregister;
Viresh Kumarfcd7af92014-01-07 07:10:10 +05301201 blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
1202 CPUFREQ_CREATE_POLICY, policy);
Srivatsa S. Bhata82fab22013-07-30 04:24:49 +05301203 }
Dave Jones8ff69732006-03-05 03:37:23 -05001204
Viresh Kumar9515f4d2013-08-20 12:08:23 +05301205 write_lock_irqsave(&cpufreq_driver_lock, flags);
1206 list_add(&policy->policy_list, &cpufreq_policy_list);
1207 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
1208
Srivatsa S. Bhate18f1682013-07-30 04:24:23 +05301209 cpufreq_init_policy(policy);
1210
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301211 if (!recover_policy) {
Viresh Kumar08fd8c1c2013-12-24 07:11:01 +05301212 policy->user_policy.policy = policy->policy;
1213 policy->user_policy.governor = policy->governor;
1214 }
Viresh Kumar4e97b632014-03-04 11:44:01 +08001215 up_write(&policy->rwsem);
Viresh Kumar08fd8c1c2013-12-24 07:11:01 +05301216
Greg Kroah-Hartman038c5b32007-12-17 15:54:39 -04001217 kobject_uevent(&policy->kobj, KOBJ_ADD);
Viresh Kumar6eed9402013-08-06 22:53:11 +05301218 up_read(&cpufreq_rwsem);
1219
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02001220 pr_debug("initialization complete\n");
Dave Jones87c32272006-03-29 01:48:37 -05001221
Linus Torvalds1da177e2005-04-16 15:20:36 -07001222 return 0;
1223
Linus Torvalds1da177e2005-04-16 15:20:36 -07001224err_out_unregister:
Viresh Kumar652ed952014-01-09 20:38:43 +05301225err_get_freq:
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00001226 write_lock_irqsave(&cpufreq_driver_lock, flags);
Viresh Kumar474deff2013-08-20 12:08:25 +05301227 for_each_cpu(j, policy->cpus)
Mike Travis7a6aedf2008-03-25 15:06:53 -07001228 per_cpu(cpufreq_cpu_data, j) = NULL;
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00001229 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001230
Viresh Kumarda60ce92013-10-03 20:28:30 +05301231 if (cpufreq_driver->exit)
1232 cpufreq_driver->exit(policy);
Viresh Kumar2eaa3e22013-02-07 10:55:00 +05301233err_set_policy_cpu:
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301234 if (recover_policy) {
Rafael J. Wysocki72368d12013-12-27 01:07:11 +01001235 /* Do not leave stale fallback data behind. */
1236 per_cpu(cpufreq_cpu_data_fallback, cpu) = NULL;
Viresh Kumar42f921a2013-12-20 21:26:02 +05301237 cpufreq_policy_put_kobj(policy);
Rafael J. Wysocki72368d12013-12-27 01:07:11 +01001238 }
Srivatsa S. Bhate9698cc2013-07-30 04:24:11 +05301239 cpufreq_policy_free(policy);
Viresh Kumar42f921a2013-12-20 21:26:02 +05301240
Linus Torvalds1da177e2005-04-16 15:20:36 -07001241nomem_out:
Viresh Kumar6eed9402013-08-06 22:53:11 +05301242 up_read(&cpufreq_rwsem);
1243
Linus Torvalds1da177e2005-04-16 15:20:36 -07001244 return ret;
1245}
1246
Srivatsa S. Bhata82fab22013-07-30 04:24:49 +05301247/**
1248 * cpufreq_add_dev - add a CPU device
1249 *
1250 * Adds the cpufreq interface for a CPU device.
1251 *
1252 * The Oracle says: try running cpufreq registration/unregistration concurrently
1253 * with with cpu hotplugging and all hell will break loose. Tried to clean this
1254 * mess up, but more thorough testing is needed. - Mathieu
1255 */
1256static int cpufreq_add_dev(struct device *dev, struct subsys_interface *sif)
1257{
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301258 return __cpufreq_add_dev(dev, sif);
Srivatsa S. Bhata82fab22013-07-30 04:24:49 +05301259}
1260
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301261static int cpufreq_nominate_new_policy_cpu(struct cpufreq_policy *policy,
Viresh Kumar42f921a2013-12-20 21:26:02 +05301262 unsigned int old_cpu)
Srivatsa S. Bhatf9ba6802013-07-30 04:24:36 +05301263{
1264 struct device *cpu_dev;
Srivatsa S. Bhatf9ba6802013-07-30 04:24:36 +05301265 int ret;
1266
1267 /* first sibling now owns the new sysfs dir */
Viresh Kumar9c8f1ee2013-09-12 17:06:33 +05301268 cpu_dev = get_cpu_device(cpumask_any_but(policy->cpus, old_cpu));
Srivatsa S. Bhata82fab22013-07-30 04:24:49 +05301269
Srivatsa S. Bhatf9ba6802013-07-30 04:24:36 +05301270 sysfs_remove_link(&cpu_dev->kobj, "cpufreq");
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301271 ret = kobject_move(&policy->kobj, &cpu_dev->kobj);
Srivatsa S. Bhatf9ba6802013-07-30 04:24:36 +05301272 if (ret) {
Joe Perchese837f9b2014-03-11 10:03:00 -07001273 pr_err("%s: Failed to move kobj: %d\n", __func__, ret);
Srivatsa S. Bhatf9ba6802013-07-30 04:24:36 +05301274
viresh kumarad7722d2013-10-18 19:10:15 +05301275 down_write(&policy->rwsem);
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301276 cpumask_set_cpu(old_cpu, policy->cpus);
viresh kumarad7722d2013-10-18 19:10:15 +05301277 up_write(&policy->rwsem);
Srivatsa S. Bhatf9ba6802013-07-30 04:24:36 +05301278
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301279 ret = sysfs_create_link(&cpu_dev->kobj, &policy->kobj,
Srivatsa S. Bhatf9ba6802013-07-30 04:24:36 +05301280 "cpufreq");
1281
1282 return -EINVAL;
1283 }
1284
1285 return cpu_dev->id;
1286}
1287
Srivatsa S. Bhatcedb70a2013-09-07 01:23:09 +05301288static int __cpufreq_remove_dev_prepare(struct device *dev,
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301289 struct subsys_interface *sif)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001290{
Srivatsa S. Bhatf9ba6802013-07-30 04:24:36 +05301291 unsigned int cpu = dev->id, cpus;
Viresh Kumar3de9bde2013-08-06 22:53:13 +05301292 int new_cpu, ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001293 unsigned long flags;
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301294 struct cpufreq_policy *policy;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001295
Viresh Kumarb8eed8a2013-01-14 13:23:03 +00001296 pr_debug("%s: unregistering CPU %u\n", __func__, cpu);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001297
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00001298 write_lock_irqsave(&cpufreq_driver_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001299
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301300 policy = per_cpu(cpufreq_cpu_data, cpu);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001301
Srivatsa S. Bhat84148092013-07-30 04:25:10 +05301302 /* Save the policy somewhere when doing a light-weight tear-down */
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301303 if (cpufreq_suspended)
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301304 per_cpu(cpufreq_cpu_data_fallback, cpu) = policy;
Srivatsa S. Bhat84148092013-07-30 04:25:10 +05301305
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00001306 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001307
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301308 if (!policy) {
Viresh Kumarb8eed8a2013-01-14 13:23:03 +00001309 pr_debug("%s: No cpu_data found\n", __func__);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001310 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001311 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001312
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +05301313 if (has_target()) {
Viresh Kumar3de9bde2013-08-06 22:53:13 +05301314 ret = __cpufreq_governor(policy, CPUFREQ_GOV_STOP);
1315 if (ret) {
1316 pr_err("%s: Failed to stop governor\n", __func__);
1317 return ret;
1318 }
1319 }
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08001320
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02001321 if (!cpufreq_driver->setpolicy)
Dirk Brandewiefa69e332013-02-06 09:02:11 -08001322 strncpy(per_cpu(cpufreq_cpu_governor, cpu),
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301323 policy->governor->name, CPUFREQ_NAME_LEN);
Jacob Shin27ecddc2011-04-27 13:32:11 -05001324
viresh kumarad7722d2013-10-18 19:10:15 +05301325 down_read(&policy->rwsem);
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301326 cpus = cpumask_weight(policy->cpus);
viresh kumarad7722d2013-10-18 19:10:15 +05301327 up_read(&policy->rwsem);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001328
Srivatsa S. Bhat61173f22013-09-12 01:43:25 +05301329 if (cpu != policy->cpu) {
viresh kumar6964d912014-02-17 14:52:11 +05301330 sysfs_remove_link(&dev->kobj, "cpufreq");
Viresh Kumar73bf0fc2013-02-05 22:21:14 +01001331 } else if (cpus > 1) {
Viresh Kumar42f921a2013-12-20 21:26:02 +05301332 new_cpu = cpufreq_nominate_new_policy_cpu(policy, cpu);
Srivatsa S. Bhatf9ba6802013-07-30 04:24:36 +05301333 if (new_cpu >= 0) {
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301334 update_policy_cpu(policy, new_cpu);
Srivatsa S. Bhata82fab22013-07-30 04:24:49 +05301335
Stratos Karafotisbda9f552014-03-20 01:25:13 +02001336 if (!cpufreq_suspended)
Viresh Kumar75949c92013-10-02 14:13:13 +05301337 pr_debug("%s: policy Kobject moved to cpu: %d from: %d\n",
Joe Perchese837f9b2014-03-11 10:03:00 -07001338 __func__, new_cpu, cpu);
Viresh Kumarb8eed8a2013-01-14 13:23:03 +00001339 }
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08001340 }
Venki Pallipadiec282972007-03-26 12:03:19 -07001341
Srivatsa S. Bhatcedb70a2013-09-07 01:23:09 +05301342 return 0;
1343}
1344
1345static int __cpufreq_remove_dev_finish(struct device *dev,
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301346 struct subsys_interface *sif)
Srivatsa S. Bhatcedb70a2013-09-07 01:23:09 +05301347{
1348 unsigned int cpu = dev->id, cpus;
1349 int ret;
1350 unsigned long flags;
1351 struct cpufreq_policy *policy;
Srivatsa S. Bhatcedb70a2013-09-07 01:23:09 +05301352
1353 read_lock_irqsave(&cpufreq_driver_lock, flags);
1354 policy = per_cpu(cpufreq_cpu_data, cpu);
1355 read_unlock_irqrestore(&cpufreq_driver_lock, flags);
1356
1357 if (!policy) {
1358 pr_debug("%s: No cpu_data found\n", __func__);
1359 return -EINVAL;
1360 }
1361
viresh kumarad7722d2013-10-18 19:10:15 +05301362 down_write(&policy->rwsem);
Srivatsa S. Bhatcedb70a2013-09-07 01:23:09 +05301363 cpus = cpumask_weight(policy->cpus);
Viresh Kumar9c8f1ee2013-09-12 17:06:33 +05301364
1365 if (cpus > 1)
1366 cpumask_clear_cpu(cpu, policy->cpus);
viresh kumarad7722d2013-10-18 19:10:15 +05301367 up_write(&policy->rwsem);
Srivatsa S. Bhatcedb70a2013-09-07 01:23:09 +05301368
Viresh Kumarb8eed8a2013-01-14 13:23:03 +00001369 /* If cpu is last user of policy, free policy */
1370 if (cpus == 1) {
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +05301371 if (has_target()) {
Viresh Kumar3de9bde2013-08-06 22:53:13 +05301372 ret = __cpufreq_governor(policy,
1373 CPUFREQ_GOV_POLICY_EXIT);
1374 if (ret) {
1375 pr_err("%s: Failed to exit governor\n",
Joe Perchese837f9b2014-03-11 10:03:00 -07001376 __func__);
Viresh Kumar3de9bde2013-08-06 22:53:13 +05301377 return ret;
1378 }
Viresh Kumaredab2fb2013-08-20 12:08:22 +05301379 }
Rafael J. Wysocki2a998592013-07-30 00:32:00 +02001380
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301381 if (!cpufreq_suspended)
Viresh Kumar42f921a2013-12-20 21:26:02 +05301382 cpufreq_policy_put_kobj(policy);
Srivatsa S. Bhat84148092013-07-30 04:25:10 +05301383
1384 /*
1385 * Perform the ->exit() even during light-weight tear-down,
1386 * since this is a core component, and is essential for the
1387 * subsequent light-weight ->init() to succeed.
Viresh Kumarb8eed8a2013-01-14 13:23:03 +00001388 */
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02001389 if (cpufreq_driver->exit)
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301390 cpufreq_driver->exit(policy);
Viresh Kumarb8eed8a2013-01-14 13:23:03 +00001391
Viresh Kumar9515f4d2013-08-20 12:08:23 +05301392 /* Remove policy from list of active policies */
1393 write_lock_irqsave(&cpufreq_driver_lock, flags);
1394 list_del(&policy->policy_list);
1395 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
1396
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301397 if (!cpufreq_suspended)
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301398 cpufreq_policy_free(policy);
Stratos Karafotise5c87b72014-03-19 23:29:17 +02001399 } else if (has_target()) {
1400 ret = __cpufreq_governor(policy, CPUFREQ_GOV_START);
1401 if (!ret)
1402 ret = __cpufreq_governor(policy, CPUFREQ_GOV_LIMITS);
1403
1404 if (ret) {
1405 pr_err("%s: Failed to start governor\n", __func__);
1406 return ret;
Rafael J. Wysocki2a998592013-07-30 00:32:00 +02001407 }
Viresh Kumarb8eed8a2013-01-14 13:23:03 +00001408 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001409
Viresh Kumar474deff2013-08-20 12:08:25 +05301410 per_cpu(cpufreq_cpu_data, cpu) = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001411 return 0;
1412}
1413
Srivatsa S. Bhatcedb70a2013-09-07 01:23:09 +05301414/**
Viresh Kumar27a862e2013-10-02 14:13:14 +05301415 * cpufreq_remove_dev - remove a CPU device
Srivatsa S. Bhatcedb70a2013-09-07 01:23:09 +05301416 *
1417 * Removes the cpufreq interface for a CPU device.
Srivatsa S. Bhatcedb70a2013-09-07 01:23:09 +05301418 */
Kay Sievers8a25a2f2011-12-21 14:29:42 -08001419static int cpufreq_remove_dev(struct device *dev, struct subsys_interface *sif)
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08001420{
Kay Sievers8a25a2f2011-12-21 14:29:42 -08001421 unsigned int cpu = dev->id;
Viresh Kumar27a862e2013-10-02 14:13:14 +05301422 int ret;
Venki Pallipadiec282972007-03-26 12:03:19 -07001423
1424 if (cpu_is_offline(cpu))
1425 return 0;
1426
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301427 ret = __cpufreq_remove_dev_prepare(dev, sif);
Viresh Kumar27a862e2013-10-02 14:13:14 +05301428
1429 if (!ret)
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301430 ret = __cpufreq_remove_dev_finish(dev, sif);
Viresh Kumar27a862e2013-10-02 14:13:14 +05301431
1432 return ret;
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08001433}
1434
David Howells65f27f32006-11-22 14:55:48 +00001435static void handle_update(struct work_struct *work)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001436{
David Howells65f27f32006-11-22 14:55:48 +00001437 struct cpufreq_policy *policy =
1438 container_of(work, struct cpufreq_policy, update);
1439 unsigned int cpu = policy->cpu;
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02001440 pr_debug("handle_update for cpu %u called\n", cpu);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001441 cpufreq_update_policy(cpu);
1442}
1443
1444/**
Viresh Kumarbb176f72013-06-19 14:19:33 +05301445 * cpufreq_out_of_sync - If actual and saved CPU frequency differs, we're
1446 * in deep trouble.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001447 * @cpu: cpu number
1448 * @old_freq: CPU frequency the kernel thinks the CPU runs at
1449 * @new_freq: CPU frequency the CPU actually runs at
1450 *
Dave Jones29464f22009-01-18 01:37:11 -05001451 * We adjust to current frequency first, and need to clean up later.
1452 * So either call to cpufreq_update_policy() or schedule handle_update()).
Linus Torvalds1da177e2005-04-16 15:20:36 -07001453 */
Gautham R Shenoye08f5f52006-10-26 16:20:58 +05301454static void cpufreq_out_of_sync(unsigned int cpu, unsigned int old_freq,
1455 unsigned int new_freq)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001456{
Viresh Kumarb43a7ff2013-03-24 11:56:43 +05301457 struct cpufreq_policy *policy;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001458 struct cpufreq_freqs freqs;
Viresh Kumarb43a7ff2013-03-24 11:56:43 +05301459 unsigned long flags;
1460
Joe Perchese837f9b2014-03-11 10:03:00 -07001461 pr_debug("Warning: CPU frequency out of sync: cpufreq and timing core thinks of %u, is %u kHz\n",
1462 old_freq, new_freq);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001463
Linus Torvalds1da177e2005-04-16 15:20:36 -07001464 freqs.old = old_freq;
1465 freqs.new = new_freq;
Viresh Kumarb43a7ff2013-03-24 11:56:43 +05301466
1467 read_lock_irqsave(&cpufreq_driver_lock, flags);
1468 policy = per_cpu(cpufreq_cpu_data, cpu);
1469 read_unlock_irqrestore(&cpufreq_driver_lock, flags);
1470
1471 cpufreq_notify_transition(policy, &freqs, CPUFREQ_PRECHANGE);
1472 cpufreq_notify_transition(policy, &freqs, CPUFREQ_POSTCHANGE);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001473}
1474
Dave Jones32ee8c32006-02-28 00:43:23 -05001475/**
Dhaval Giani4ab70df2006-12-13 14:49:15 +05301476 * cpufreq_quick_get - get the CPU frequency (in kHz) from policy->cur
Venkatesh Pallipadi95235ca2005-12-02 10:43:20 -08001477 * @cpu: CPU number
1478 *
1479 * This is the last known freq, without actually getting it from the driver.
1480 * Return value will be same as what is shown in scaling_cur_freq in sysfs.
1481 */
1482unsigned int cpufreq_quick_get(unsigned int cpu)
1483{
Dirk Brandewie9e21ba82013-02-06 09:02:08 -08001484 struct cpufreq_policy *policy;
Gautham R Shenoye08f5f52006-10-26 16:20:58 +05301485 unsigned int ret_freq = 0;
Venkatesh Pallipadi95235ca2005-12-02 10:43:20 -08001486
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02001487 if (cpufreq_driver && cpufreq_driver->setpolicy && cpufreq_driver->get)
1488 return cpufreq_driver->get(cpu);
Dirk Brandewie9e21ba82013-02-06 09:02:08 -08001489
1490 policy = cpufreq_cpu_get(cpu);
Venkatesh Pallipadi95235ca2005-12-02 10:43:20 -08001491 if (policy) {
Gautham R Shenoye08f5f52006-10-26 16:20:58 +05301492 ret_freq = policy->cur;
Venkatesh Pallipadi95235ca2005-12-02 10:43:20 -08001493 cpufreq_cpu_put(policy);
1494 }
1495
Dave Jones4d34a672008-02-07 16:33:49 -05001496 return ret_freq;
Venkatesh Pallipadi95235ca2005-12-02 10:43:20 -08001497}
1498EXPORT_SYMBOL(cpufreq_quick_get);
1499
Jesse Barnes3d737102011-06-28 10:59:12 -07001500/**
1501 * cpufreq_quick_get_max - get the max reported CPU frequency for this CPU
1502 * @cpu: CPU number
1503 *
1504 * Just return the max possible frequency for a given CPU.
1505 */
1506unsigned int cpufreq_quick_get_max(unsigned int cpu)
1507{
1508 struct cpufreq_policy *policy = cpufreq_cpu_get(cpu);
1509 unsigned int ret_freq = 0;
1510
1511 if (policy) {
1512 ret_freq = policy->max;
1513 cpufreq_cpu_put(policy);
1514 }
1515
1516 return ret_freq;
1517}
1518EXPORT_SYMBOL(cpufreq_quick_get_max);
1519
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08001520static unsigned int __cpufreq_get(unsigned int cpu)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001521{
Mike Travis7a6aedf2008-03-25 15:06:53 -07001522 struct cpufreq_policy *policy = per_cpu(cpufreq_cpu_data, cpu);
Gautham R Shenoye08f5f52006-10-26 16:20:58 +05301523 unsigned int ret_freq = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001524
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02001525 if (!cpufreq_driver->get)
Dave Jones4d34a672008-02-07 16:33:49 -05001526 return ret_freq;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001527
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02001528 ret_freq = cpufreq_driver->get(cpu);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001529
Gautham R Shenoye08f5f52006-10-26 16:20:58 +05301530 if (ret_freq && policy->cur &&
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02001531 !(cpufreq_driver->flags & CPUFREQ_CONST_LOOPS)) {
Gautham R Shenoye08f5f52006-10-26 16:20:58 +05301532 /* verify no discrepancy between actual and
1533 saved value exists */
1534 if (unlikely(ret_freq != policy->cur)) {
1535 cpufreq_out_of_sync(cpu, policy->cur, ret_freq);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001536 schedule_work(&policy->update);
1537 }
1538 }
1539
Dave Jones4d34a672008-02-07 16:33:49 -05001540 return ret_freq;
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08001541}
Linus Torvalds1da177e2005-04-16 15:20:36 -07001542
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08001543/**
1544 * cpufreq_get - get the current CPU frequency (in kHz)
1545 * @cpu: CPU number
1546 *
1547 * Get the CPU current (static) CPU frequency
1548 */
1549unsigned int cpufreq_get(unsigned int cpu)
1550{
Aaron Plattner999976e2014-03-04 12:42:15 -08001551 struct cpufreq_policy *policy = cpufreq_cpu_get(cpu);
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08001552 unsigned int ret_freq = 0;
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08001553
Aaron Plattner999976e2014-03-04 12:42:15 -08001554 if (policy) {
1555 down_read(&policy->rwsem);
1556 ret_freq = __cpufreq_get(cpu);
1557 up_read(&policy->rwsem);
Viresh Kumar26ca8692013-09-20 22:37:31 +05301558
Aaron Plattner999976e2014-03-04 12:42:15 -08001559 cpufreq_cpu_put(policy);
1560 }
Viresh Kumar6eed9402013-08-06 22:53:11 +05301561
Dave Jones4d34a672008-02-07 16:33:49 -05001562 return ret_freq;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001563}
1564EXPORT_SYMBOL(cpufreq_get);
1565
Kay Sievers8a25a2f2011-12-21 14:29:42 -08001566static struct subsys_interface cpufreq_interface = {
1567 .name = "cpufreq",
1568 .subsys = &cpu_subsys,
1569 .add_dev = cpufreq_add_dev,
1570 .remove_dev = cpufreq_remove_dev,
Rafael J. Wysockie00e56d2011-03-23 22:16:32 +01001571};
1572
Viresh Kumare28867e2014-03-04 11:00:27 +08001573/*
1574 * In case platform wants some specific frequency to be configured
1575 * during suspend..
Benjamin Herrenschmidt42d4dc32005-04-29 07:40:12 -07001576 */
Viresh Kumare28867e2014-03-04 11:00:27 +08001577int cpufreq_generic_suspend(struct cpufreq_policy *policy)
Benjamin Herrenschmidt42d4dc32005-04-29 07:40:12 -07001578{
Viresh Kumare28867e2014-03-04 11:00:27 +08001579 int ret;
Dave Jones4bc5d342009-08-04 14:03:25 -04001580
Viresh Kumare28867e2014-03-04 11:00:27 +08001581 if (!policy->suspend_freq) {
1582 pr_err("%s: suspend_freq can't be zero\n", __func__);
1583 return -EINVAL;
Benjamin Herrenschmidt42d4dc32005-04-29 07:40:12 -07001584 }
1585
Viresh Kumare28867e2014-03-04 11:00:27 +08001586 pr_debug("%s: Setting suspend-freq: %u\n", __func__,
1587 policy->suspend_freq);
1588
1589 ret = __cpufreq_driver_target(policy, policy->suspend_freq,
1590 CPUFREQ_RELATION_H);
1591 if (ret)
1592 pr_err("%s: unable to set suspend-freq: %u. err: %d\n",
1593 __func__, policy->suspend_freq, ret);
1594
Dave Jonesc9060492008-02-07 16:32:18 -05001595 return ret;
Benjamin Herrenschmidt42d4dc32005-04-29 07:40:12 -07001596}
Viresh Kumare28867e2014-03-04 11:00:27 +08001597EXPORT_SYMBOL(cpufreq_generic_suspend);
Benjamin Herrenschmidt42d4dc32005-04-29 07:40:12 -07001598
1599/**
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001600 * cpufreq_suspend() - Suspend CPUFreq governors
Linus Torvalds1da177e2005-04-16 15:20:36 -07001601 *
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001602 * Called during system wide Suspend/Hibernate cycles for suspending governors
1603 * as some platforms can't change frequency after this point in suspend cycle.
1604 * Because some of the devices (like: i2c, regulators, etc) they use for
1605 * changing frequency are suspended quickly after this point.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001606 */
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001607void cpufreq_suspend(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001608{
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301609 struct cpufreq_policy *policy;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001610
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001611 if (!cpufreq_driver)
Rafael J. Wysockie00e56d2011-03-23 22:16:32 +01001612 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001613
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001614 if (!has_target())
1615 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001616
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001617 pr_debug("%s: Suspending Governors\n", __func__);
1618
1619 list_for_each_entry(policy, &cpufreq_policy_list, policy_list) {
1620 if (__cpufreq_governor(policy, CPUFREQ_GOV_STOP))
1621 pr_err("%s: Failed to stop governor for policy: %p\n",
1622 __func__, policy);
1623 else if (cpufreq_driver->suspend
1624 && cpufreq_driver->suspend(policy))
1625 pr_err("%s: Failed to suspend driver: %p\n", __func__,
1626 policy);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001627 }
1628
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001629 cpufreq_suspended = true;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001630}
1631
Linus Torvalds1da177e2005-04-16 15:20:36 -07001632/**
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001633 * cpufreq_resume() - Resume CPUFreq governors
Linus Torvalds1da177e2005-04-16 15:20:36 -07001634 *
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001635 * Called during system wide Suspend/Hibernate cycle for resuming governors that
1636 * are suspended with cpufreq_suspend().
Linus Torvalds1da177e2005-04-16 15:20:36 -07001637 */
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001638void cpufreq_resume(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001639{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001640 struct cpufreq_policy *policy;
1641
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001642 if (!cpufreq_driver)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001643 return;
1644
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001645 if (!has_target())
1646 return;
1647
1648 pr_debug("%s: Resuming Governors\n", __func__);
1649
1650 cpufreq_suspended = false;
1651
1652 list_for_each_entry(policy, &cpufreq_policy_list, policy_list) {
1653 if (__cpufreq_governor(policy, CPUFREQ_GOV_START)
1654 || __cpufreq_governor(policy, CPUFREQ_GOV_LIMITS))
1655 pr_err("%s: Failed to start governor for policy: %p\n",
1656 __func__, policy);
1657 else if (cpufreq_driver->resume
1658 && cpufreq_driver->resume(policy))
1659 pr_err("%s: Failed to resume driver: %p\n", __func__,
1660 policy);
1661
1662 /*
1663 * schedule call cpufreq_update_policy() for boot CPU, i.e. last
1664 * policy in list. It will verify that the current freq is in
1665 * sync with what we believe it to be.
1666 */
1667 if (list_is_last(&policy->policy_list, &cpufreq_policy_list))
1668 schedule_work(&policy->update);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001669 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001670}
Linus Torvalds1da177e2005-04-16 15:20:36 -07001671
Borislav Petkov9d950462013-01-20 10:24:28 +00001672/**
1673 * cpufreq_get_current_driver - return current driver's name
1674 *
1675 * Return the name string of the currently loaded cpufreq driver
1676 * or NULL, if none.
1677 */
1678const char *cpufreq_get_current_driver(void)
1679{
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02001680 if (cpufreq_driver)
1681 return cpufreq_driver->name;
1682
1683 return NULL;
Borislav Petkov9d950462013-01-20 10:24:28 +00001684}
1685EXPORT_SYMBOL_GPL(cpufreq_get_current_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001686
1687/*********************************************************************
1688 * NOTIFIER LISTS INTERFACE *
1689 *********************************************************************/
1690
1691/**
1692 * cpufreq_register_notifier - register a driver with cpufreq
1693 * @nb: notifier function to register
1694 * @list: CPUFREQ_TRANSITION_NOTIFIER or CPUFREQ_POLICY_NOTIFIER
1695 *
Dave Jones32ee8c32006-02-28 00:43:23 -05001696 * Add a driver to one of two lists: either a list of drivers that
Linus Torvalds1da177e2005-04-16 15:20:36 -07001697 * are notified about clock rate changes (once before and once after
1698 * the transition), or a list of drivers that are notified about
1699 * changes in cpufreq policy.
1700 *
1701 * This function may sleep, and has the same return conditions as
Alan Sterne041c682006-03-27 01:16:30 -08001702 * blocking_notifier_chain_register.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001703 */
1704int cpufreq_register_notifier(struct notifier_block *nb, unsigned int list)
1705{
1706 int ret;
1707
Dirk Brandewied5aaffa2013-01-17 16:22:21 +00001708 if (cpufreq_disabled())
1709 return -EINVAL;
1710
Cesar Eduardo Barros74212ca2008-02-16 08:41:24 -02001711 WARN_ON(!init_cpufreq_transition_notifier_list_called);
1712
Linus Torvalds1da177e2005-04-16 15:20:36 -07001713 switch (list) {
1714 case CPUFREQ_TRANSITION_NOTIFIER:
Alan Sternb4dfdbb2006-10-04 02:17:06 -07001715 ret = srcu_notifier_chain_register(
Alan Sterne041c682006-03-27 01:16:30 -08001716 &cpufreq_transition_notifier_list, nb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001717 break;
1718 case CPUFREQ_POLICY_NOTIFIER:
Alan Sterne041c682006-03-27 01:16:30 -08001719 ret = blocking_notifier_chain_register(
1720 &cpufreq_policy_notifier_list, nb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001721 break;
1722 default:
1723 ret = -EINVAL;
1724 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001725
1726 return ret;
1727}
1728EXPORT_SYMBOL(cpufreq_register_notifier);
1729
Linus Torvalds1da177e2005-04-16 15:20:36 -07001730/**
1731 * cpufreq_unregister_notifier - unregister a driver with cpufreq
1732 * @nb: notifier block to be unregistered
Viresh Kumarbb176f72013-06-19 14:19:33 +05301733 * @list: CPUFREQ_TRANSITION_NOTIFIER or CPUFREQ_POLICY_NOTIFIER
Linus Torvalds1da177e2005-04-16 15:20:36 -07001734 *
1735 * Remove a driver from the CPU frequency notifier list.
1736 *
1737 * This function may sleep, and has the same return conditions as
Alan Sterne041c682006-03-27 01:16:30 -08001738 * blocking_notifier_chain_unregister.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001739 */
1740int cpufreq_unregister_notifier(struct notifier_block *nb, unsigned int list)
1741{
1742 int ret;
1743
Dirk Brandewied5aaffa2013-01-17 16:22:21 +00001744 if (cpufreq_disabled())
1745 return -EINVAL;
1746
Linus Torvalds1da177e2005-04-16 15:20:36 -07001747 switch (list) {
1748 case CPUFREQ_TRANSITION_NOTIFIER:
Alan Sternb4dfdbb2006-10-04 02:17:06 -07001749 ret = srcu_notifier_chain_unregister(
Alan Sterne041c682006-03-27 01:16:30 -08001750 &cpufreq_transition_notifier_list, nb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001751 break;
1752 case CPUFREQ_POLICY_NOTIFIER:
Alan Sterne041c682006-03-27 01:16:30 -08001753 ret = blocking_notifier_chain_unregister(
1754 &cpufreq_policy_notifier_list, nb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001755 break;
1756 default:
1757 ret = -EINVAL;
1758 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001759
1760 return ret;
1761}
1762EXPORT_SYMBOL(cpufreq_unregister_notifier);
1763
1764
1765/*********************************************************************
1766 * GOVERNORS *
1767 *********************************************************************/
1768
Linus Torvalds1da177e2005-04-16 15:20:36 -07001769int __cpufreq_driver_target(struct cpufreq_policy *policy,
1770 unsigned int target_freq,
1771 unsigned int relation)
1772{
1773 int retval = -EINVAL;
Viresh Kumar72499242012-10-31 01:28:21 +01001774 unsigned int old_target_freq = target_freq;
Ashok Rajc32b6b82005-10-30 14:59:54 -08001775
Konrad Rzeszutek Wilka7b422c2012-03-13 19:18:39 -04001776 if (cpufreq_disabled())
1777 return -ENODEV;
1778
Viresh Kumar72499242012-10-31 01:28:21 +01001779 /* Make sure that target_freq is within supported range */
1780 if (target_freq > policy->max)
1781 target_freq = policy->max;
1782 if (target_freq < policy->min)
1783 target_freq = policy->min;
1784
1785 pr_debug("target for CPU %u: %u kHz, relation %u, requested %u kHz\n",
Joe Perchese837f9b2014-03-11 10:03:00 -07001786 policy->cpu, target_freq, relation, old_target_freq);
Viresh Kumar5a1c0222012-10-31 01:28:15 +01001787
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +05301788 /*
1789 * This might look like a redundant call as we are checking it again
1790 * after finding index. But it is left intentionally for cases where
1791 * exactly same freq is called again and so we can save on few function
1792 * calls.
1793 */
Viresh Kumar5a1c0222012-10-31 01:28:15 +01001794 if (target_freq == policy->cur)
1795 return 0;
1796
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02001797 if (cpufreq_driver->target)
1798 retval = cpufreq_driver->target(policy, target_freq, relation);
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +05301799 else if (cpufreq_driver->target_index) {
1800 struct cpufreq_frequency_table *freq_table;
Viresh Kumard4019f02013-08-14 19:38:24 +05301801 struct cpufreq_freqs freqs;
1802 bool notify;
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +05301803 int index;
Ashok Raj90d45d12005-11-08 21:34:24 -08001804
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +05301805 freq_table = cpufreq_frequency_get_table(policy->cpu);
1806 if (unlikely(!freq_table)) {
1807 pr_err("%s: Unable to find freq_table\n", __func__);
1808 goto out;
1809 }
1810
1811 retval = cpufreq_frequency_table_target(policy, freq_table,
1812 target_freq, relation, &index);
1813 if (unlikely(retval)) {
1814 pr_err("%s: Unable to find matching freq\n", __func__);
1815 goto out;
1816 }
1817
Viresh Kumard4019f02013-08-14 19:38:24 +05301818 if (freq_table[index].frequency == policy->cur) {
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +05301819 retval = 0;
Viresh Kumard4019f02013-08-14 19:38:24 +05301820 goto out;
1821 }
1822
1823 notify = !(cpufreq_driver->flags & CPUFREQ_ASYNC_NOTIFICATION);
1824
1825 if (notify) {
1826 freqs.old = policy->cur;
1827 freqs.new = freq_table[index].frequency;
1828 freqs.flags = 0;
1829
1830 pr_debug("%s: cpu: %d, oldfreq: %u, new freq: %u\n",
Joe Perchese837f9b2014-03-11 10:03:00 -07001831 __func__, policy->cpu, freqs.old, freqs.new);
Viresh Kumard4019f02013-08-14 19:38:24 +05301832
1833 cpufreq_notify_transition(policy, &freqs,
1834 CPUFREQ_PRECHANGE);
1835 }
1836
1837 retval = cpufreq_driver->target_index(policy, index);
1838 if (retval)
1839 pr_err("%s: Failed to change cpu frequency: %d\n",
Joe Perchese837f9b2014-03-11 10:03:00 -07001840 __func__, retval);
Viresh Kumard4019f02013-08-14 19:38:24 +05301841
Viresh Kumarab1b1c42013-12-02 11:04:13 +05301842 if (notify)
1843 cpufreq_notify_post_transition(policy, &freqs, retval);
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +05301844 }
1845
1846out:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001847 return retval;
1848}
1849EXPORT_SYMBOL_GPL(__cpufreq_driver_target);
1850
Linus Torvalds1da177e2005-04-16 15:20:36 -07001851int cpufreq_driver_target(struct cpufreq_policy *policy,
1852 unsigned int target_freq,
1853 unsigned int relation)
1854{
Julia Lawallf1829e42008-07-25 22:44:53 +02001855 int ret = -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001856
viresh kumarad7722d2013-10-18 19:10:15 +05301857 down_write(&policy->rwsem);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001858
1859 ret = __cpufreq_driver_target(policy, target_freq, relation);
1860
viresh kumarad7722d2013-10-18 19:10:15 +05301861 up_write(&policy->rwsem);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001862
Linus Torvalds1da177e2005-04-16 15:20:36 -07001863 return ret;
1864}
1865EXPORT_SYMBOL_GPL(cpufreq_driver_target);
1866
Arjan van de Ven153d7f32006-07-26 15:40:07 +02001867/*
Arjan van de Ven153d7f32006-07-26 15:40:07 +02001868 * when "event" is CPUFREQ_GOV_LIMITS
1869 */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001870
Gautham R Shenoye08f5f52006-10-26 16:20:58 +05301871static int __cpufreq_governor(struct cpufreq_policy *policy,
1872 unsigned int event)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001873{
Dave Jonescc993ca2005-07-28 09:43:56 -07001874 int ret;
Thomas Renninger6afde102007-10-02 13:28:13 -07001875
1876 /* Only must be defined when default governor is known to have latency
1877 restrictions, like e.g. conservative or ondemand.
1878 That this is the case is already ensured in Kconfig
1879 */
1880#ifdef CONFIG_CPU_FREQ_GOV_PERFORMANCE
1881 struct cpufreq_governor *gov = &cpufreq_gov_performance;
1882#else
1883 struct cpufreq_governor *gov = NULL;
1884#endif
Thomas Renninger1c256242007-10-02 13:28:12 -07001885
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001886 /* Don't start any governor operations if we are entering suspend */
1887 if (cpufreq_suspended)
1888 return 0;
1889
Thomas Renninger1c256242007-10-02 13:28:12 -07001890 if (policy->governor->max_transition_latency &&
1891 policy->cpuinfo.transition_latency >
1892 policy->governor->max_transition_latency) {
Thomas Renninger6afde102007-10-02 13:28:13 -07001893 if (!gov)
1894 return -EINVAL;
1895 else {
Joe Perchese837f9b2014-03-11 10:03:00 -07001896 pr_warn("%s governor failed, too long transition latency of HW, fallback to %s governor\n",
1897 policy->governor->name, gov->name);
Thomas Renninger6afde102007-10-02 13:28:13 -07001898 policy->governor = gov;
1899 }
Thomas Renninger1c256242007-10-02 13:28:12 -07001900 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001901
Viresh Kumarfe492f32013-08-06 22:53:10 +05301902 if (event == CPUFREQ_GOV_POLICY_INIT)
1903 if (!try_module_get(policy->governor->owner))
1904 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001905
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02001906 pr_debug("__cpufreq_governor for CPU %u, event %u\n",
Joe Perchese837f9b2014-03-11 10:03:00 -07001907 policy->cpu, event);
Xiaoguang Chen95731eb2013-06-19 15:00:07 +08001908
1909 mutex_lock(&cpufreq_governor_lock);
Srivatsa S. Bhat56d07db2013-09-07 01:23:55 +05301910 if ((policy->governor_enabled && event == CPUFREQ_GOV_START)
Viresh Kumarf73d3932013-08-31 17:53:40 +05301911 || (!policy->governor_enabled
1912 && (event == CPUFREQ_GOV_LIMITS || event == CPUFREQ_GOV_STOP))) {
Xiaoguang Chen95731eb2013-06-19 15:00:07 +08001913 mutex_unlock(&cpufreq_governor_lock);
1914 return -EBUSY;
1915 }
1916
1917 if (event == CPUFREQ_GOV_STOP)
1918 policy->governor_enabled = false;
1919 else if (event == CPUFREQ_GOV_START)
1920 policy->governor_enabled = true;
1921
1922 mutex_unlock(&cpufreq_governor_lock);
1923
Linus Torvalds1da177e2005-04-16 15:20:36 -07001924 ret = policy->governor->governor(policy, event);
1925
Viresh Kumar4d5dcc42013-03-27 15:58:58 +00001926 if (!ret) {
1927 if (event == CPUFREQ_GOV_POLICY_INIT)
1928 policy->governor->initialized++;
1929 else if (event == CPUFREQ_GOV_POLICY_EXIT)
1930 policy->governor->initialized--;
Xiaoguang Chen95731eb2013-06-19 15:00:07 +08001931 } else {
1932 /* Restore original values */
1933 mutex_lock(&cpufreq_governor_lock);
1934 if (event == CPUFREQ_GOV_STOP)
1935 policy->governor_enabled = true;
1936 else if (event == CPUFREQ_GOV_START)
1937 policy->governor_enabled = false;
1938 mutex_unlock(&cpufreq_governor_lock);
Viresh Kumar4d5dcc42013-03-27 15:58:58 +00001939 }
Viresh Kumarb3940582013-02-01 05:42:58 +00001940
Viresh Kumarfe492f32013-08-06 22:53:10 +05301941 if (((event == CPUFREQ_GOV_POLICY_INIT) && ret) ||
1942 ((event == CPUFREQ_GOV_POLICY_EXIT) && !ret))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001943 module_put(policy->governor->owner);
1944
1945 return ret;
1946}
1947
Linus Torvalds1da177e2005-04-16 15:20:36 -07001948int cpufreq_register_governor(struct cpufreq_governor *governor)
1949{
Jeremy Fitzhardinge3bcb09a2006-07-06 12:30:26 -07001950 int err;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001951
1952 if (!governor)
1953 return -EINVAL;
1954
Konrad Rzeszutek Wilka7b422c2012-03-13 19:18:39 -04001955 if (cpufreq_disabled())
1956 return -ENODEV;
1957
akpm@osdl.org3fc54d32006-01-13 15:54:22 -08001958 mutex_lock(&cpufreq_governor_mutex);
Dave Jones32ee8c32006-02-28 00:43:23 -05001959
Viresh Kumarb3940582013-02-01 05:42:58 +00001960 governor->initialized = 0;
Jeremy Fitzhardinge3bcb09a2006-07-06 12:30:26 -07001961 err = -EBUSY;
1962 if (__find_governor(governor->name) == NULL) {
1963 err = 0;
1964 list_add(&governor->governor_list, &cpufreq_governor_list);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001965 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001966
Dave Jones32ee8c32006-02-28 00:43:23 -05001967 mutex_unlock(&cpufreq_governor_mutex);
Jeremy Fitzhardinge3bcb09a2006-07-06 12:30:26 -07001968 return err;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001969}
1970EXPORT_SYMBOL_GPL(cpufreq_register_governor);
1971
Linus Torvalds1da177e2005-04-16 15:20:36 -07001972void cpufreq_unregister_governor(struct cpufreq_governor *governor)
1973{
Prarit Bhargava90e41ba2009-11-12 09:18:46 -05001974 int cpu;
Prarit Bhargava90e41ba2009-11-12 09:18:46 -05001975
Linus Torvalds1da177e2005-04-16 15:20:36 -07001976 if (!governor)
1977 return;
1978
Konrad Rzeszutek Wilka7b422c2012-03-13 19:18:39 -04001979 if (cpufreq_disabled())
1980 return;
1981
Prarit Bhargava90e41ba2009-11-12 09:18:46 -05001982 for_each_present_cpu(cpu) {
1983 if (cpu_online(cpu))
1984 continue;
1985 if (!strcmp(per_cpu(cpufreq_cpu_governor, cpu), governor->name))
1986 strcpy(per_cpu(cpufreq_cpu_governor, cpu), "\0");
1987 }
Prarit Bhargava90e41ba2009-11-12 09:18:46 -05001988
akpm@osdl.org3fc54d32006-01-13 15:54:22 -08001989 mutex_lock(&cpufreq_governor_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001990 list_del(&governor->governor_list);
akpm@osdl.org3fc54d32006-01-13 15:54:22 -08001991 mutex_unlock(&cpufreq_governor_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001992 return;
1993}
1994EXPORT_SYMBOL_GPL(cpufreq_unregister_governor);
1995
1996
Linus Torvalds1da177e2005-04-16 15:20:36 -07001997/*********************************************************************
1998 * POLICY INTERFACE *
1999 *********************************************************************/
2000
2001/**
2002 * cpufreq_get_policy - get the current cpufreq_policy
Dave Jones29464f22009-01-18 01:37:11 -05002003 * @policy: struct cpufreq_policy into which the current cpufreq_policy
2004 * is written
Linus Torvalds1da177e2005-04-16 15:20:36 -07002005 *
2006 * Reads the current cpufreq policy.
2007 */
2008int cpufreq_get_policy(struct cpufreq_policy *policy, unsigned int cpu)
2009{
2010 struct cpufreq_policy *cpu_policy;
2011 if (!policy)
2012 return -EINVAL;
2013
2014 cpu_policy = cpufreq_cpu_get(cpu);
2015 if (!cpu_policy)
2016 return -EINVAL;
2017
Viresh Kumard5b73cd2013-08-06 22:53:06 +05302018 memcpy(policy, cpu_policy, sizeof(*policy));
Linus Torvalds1da177e2005-04-16 15:20:36 -07002019
2020 cpufreq_cpu_put(cpu_policy);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002021 return 0;
2022}
2023EXPORT_SYMBOL(cpufreq_get_policy);
2024
Arjan van de Ven153d7f32006-07-26 15:40:07 +02002025/*
Viresh Kumar037ce832013-10-02 14:13:16 +05302026 * policy : current policy.
2027 * new_policy: policy to be set.
Arjan van de Ven153d7f32006-07-26 15:40:07 +02002028 */
Viresh Kumar037ce832013-10-02 14:13:16 +05302029static int cpufreq_set_policy(struct cpufreq_policy *policy,
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302030 struct cpufreq_policy *new_policy)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002031{
Rafael J. Wysockid9a789c2014-02-17 22:56:35 +01002032 struct cpufreq_governor *old_gov;
2033 int ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002034
Joe Perchese837f9b2014-03-11 10:03:00 -07002035 pr_debug("setting new policy for CPU %u: %u - %u kHz\n",
2036 new_policy->cpu, new_policy->min, new_policy->max);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002037
Viresh Kumard5b73cd2013-08-06 22:53:06 +05302038 memcpy(&new_policy->cpuinfo, &policy->cpuinfo, sizeof(policy->cpuinfo));
Linus Torvalds1da177e2005-04-16 15:20:36 -07002039
Rafael J. Wysockid9a789c2014-02-17 22:56:35 +01002040 if (new_policy->min > policy->max || new_policy->max < policy->min)
2041 return -EINVAL;
Mattia Dongili9c9a43e2006-07-05 23:12:20 +02002042
Linus Torvalds1da177e2005-04-16 15:20:36 -07002043 /* verify the cpu speed can be set within this limit */
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302044 ret = cpufreq_driver->verify(new_policy);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002045 if (ret)
Rafael J. Wysockid9a789c2014-02-17 22:56:35 +01002046 return ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002047
Linus Torvalds1da177e2005-04-16 15:20:36 -07002048 /* adjust if necessary - all reasons */
Alan Sterne041c682006-03-27 01:16:30 -08002049 blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302050 CPUFREQ_ADJUST, new_policy);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002051
2052 /* adjust if necessary - hardware incompatibility*/
Alan Sterne041c682006-03-27 01:16:30 -08002053 blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302054 CPUFREQ_INCOMPATIBLE, new_policy);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002055
Viresh Kumarbb176f72013-06-19 14:19:33 +05302056 /*
2057 * verify the cpu speed can be set within this limit, which might be
2058 * different to the first one
2059 */
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302060 ret = cpufreq_driver->verify(new_policy);
Alan Sterne041c682006-03-27 01:16:30 -08002061 if (ret)
Rafael J. Wysockid9a789c2014-02-17 22:56:35 +01002062 return ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002063
2064 /* notification of the new policy */
Alan Sterne041c682006-03-27 01:16:30 -08002065 blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302066 CPUFREQ_NOTIFY, new_policy);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002067
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302068 policy->min = new_policy->min;
2069 policy->max = new_policy->max;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002070
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02002071 pr_debug("new min and max freqs are %u - %u kHz\n",
Joe Perchese837f9b2014-03-11 10:03:00 -07002072 policy->min, policy->max);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002073
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02002074 if (cpufreq_driver->setpolicy) {
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302075 policy->policy = new_policy->policy;
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02002076 pr_debug("setting range\n");
Rafael J. Wysockid9a789c2014-02-17 22:56:35 +01002077 return cpufreq_driver->setpolicy(new_policy);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002078 }
2079
Rafael J. Wysockid9a789c2014-02-17 22:56:35 +01002080 if (new_policy->governor == policy->governor)
2081 goto out;
2082
2083 pr_debug("governor switch\n");
2084
2085 /* save old, working values */
2086 old_gov = policy->governor;
2087 /* end old governor */
2088 if (old_gov) {
2089 __cpufreq_governor(policy, CPUFREQ_GOV_STOP);
2090 up_write(&policy->rwsem);
Stratos Karafotise5c87b72014-03-19 23:29:17 +02002091 __cpufreq_governor(policy, CPUFREQ_GOV_POLICY_EXIT);
Rafael J. Wysockid9a789c2014-02-17 22:56:35 +01002092 down_write(&policy->rwsem);
2093 }
2094
2095 /* start new governor */
2096 policy->governor = new_policy->governor;
2097 if (!__cpufreq_governor(policy, CPUFREQ_GOV_POLICY_INIT)) {
2098 if (!__cpufreq_governor(policy, CPUFREQ_GOV_START))
2099 goto out;
2100
2101 up_write(&policy->rwsem);
2102 __cpufreq_governor(policy, CPUFREQ_GOV_POLICY_EXIT);
2103 down_write(&policy->rwsem);
2104 }
2105
2106 /* new governor failed, so re-start old one */
2107 pr_debug("starting governor %s failed\n", policy->governor->name);
2108 if (old_gov) {
2109 policy->governor = old_gov;
2110 __cpufreq_governor(policy, CPUFREQ_GOV_POLICY_INIT);
2111 __cpufreq_governor(policy, CPUFREQ_GOV_START);
2112 }
2113
2114 return -EINVAL;
2115
2116 out:
2117 pr_debug("governor: change or update limits\n");
2118 return __cpufreq_governor(policy, CPUFREQ_GOV_LIMITS);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002119}
2120
2121/**
Linus Torvalds1da177e2005-04-16 15:20:36 -07002122 * cpufreq_update_policy - re-evaluate an existing cpufreq policy
2123 * @cpu: CPU which shall be re-evaluated
2124 *
Lucas De Marchi25985ed2011-03-30 22:57:33 -03002125 * Useful for policy notifiers which have different necessities
Linus Torvalds1da177e2005-04-16 15:20:36 -07002126 * at different times.
2127 */
2128int cpufreq_update_policy(unsigned int cpu)
2129{
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302130 struct cpufreq_policy *policy = cpufreq_cpu_get(cpu);
2131 struct cpufreq_policy new_policy;
Julia Lawallf1829e42008-07-25 22:44:53 +02002132 int ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002133
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302134 if (!policy) {
Julia Lawallf1829e42008-07-25 22:44:53 +02002135 ret = -ENODEV;
2136 goto no_policy;
2137 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002138
viresh kumarad7722d2013-10-18 19:10:15 +05302139 down_write(&policy->rwsem);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002140
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02002141 pr_debug("updating policy for CPU %u\n", cpu);
Viresh Kumard5b73cd2013-08-06 22:53:06 +05302142 memcpy(&new_policy, policy, sizeof(*policy));
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302143 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;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002147
Viresh Kumarbb176f72013-06-19 14:19:33 +05302148 /*
2149 * BIOS might change freq behind our back
2150 * -> ask driver for current freq and notify governors about a change
2151 */
Rafael J. Wysocki2ed99e32014-03-12 21:49:33 +01002152 if (cpufreq_driver->get && !cpufreq_driver->setpolicy) {
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302153 new_policy.cur = cpufreq_driver->get(cpu);
Viresh Kumarbd0fa9b2014-02-25 14:29:44 +05302154 if (WARN_ON(!new_policy.cur)) {
2155 ret = -EIO;
2156 goto no_policy;
2157 }
2158
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302159 if (!policy->cur) {
Joe Perchese837f9b2014-03-11 10:03:00 -07002160 pr_debug("Driver did not initialize current freq\n");
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302161 policy->cur = new_policy.cur;
Thomas Renningera85f7bd2006-02-01 11:36:04 +01002162 } else {
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +05302163 if (policy->cur != new_policy.cur && has_target())
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302164 cpufreq_out_of_sync(cpu, policy->cur,
2165 new_policy.cur);
Thomas Renningera85f7bd2006-02-01 11:36:04 +01002166 }
Thomas Renninger0961dd02006-01-26 18:46:33 +01002167 }
2168
Viresh Kumar037ce832013-10-02 14:13:16 +05302169 ret = cpufreq_set_policy(policy, &new_policy);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002170
viresh kumarad7722d2013-10-18 19:10:15 +05302171 up_write(&policy->rwsem);
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08002172
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302173 cpufreq_cpu_put(policy);
Julia Lawallf1829e42008-07-25 22:44:53 +02002174no_policy:
Linus Torvalds1da177e2005-04-16 15:20:36 -07002175 return ret;
2176}
2177EXPORT_SYMBOL(cpufreq_update_policy);
2178
Paul Gortmaker27609842013-06-19 13:54:04 -04002179static int cpufreq_cpu_callback(struct notifier_block *nfb,
Ashok Rajc32b6b82005-10-30 14:59:54 -08002180 unsigned long action, void *hcpu)
2181{
2182 unsigned int cpu = (unsigned long)hcpu;
Kay Sievers8a25a2f2011-12-21 14:29:42 -08002183 struct device *dev;
Ashok Rajc32b6b82005-10-30 14:59:54 -08002184
Kay Sievers8a25a2f2011-12-21 14:29:42 -08002185 dev = get_cpu_device(cpu);
2186 if (dev) {
Srivatsa S. Bhat5302c3f2013-07-30 04:25:25 +05302187 switch (action & ~CPU_TASKS_FROZEN) {
Ashok Rajc32b6b82005-10-30 14:59:54 -08002188 case CPU_ONLINE:
Viresh Kumar96bbbe42014-03-10 14:53:35 +05302189 __cpufreq_add_dev(dev, NULL);
Ashok Rajc32b6b82005-10-30 14:59:54 -08002190 break;
Srivatsa S. Bhat5302c3f2013-07-30 04:25:25 +05302191
Ashok Rajc32b6b82005-10-30 14:59:54 -08002192 case CPU_DOWN_PREPARE:
Viresh Kumar96bbbe42014-03-10 14:53:35 +05302193 __cpufreq_remove_dev_prepare(dev, NULL);
Srivatsa S. Bhat1aee40a2013-09-07 01:23:27 +05302194 break;
2195
2196 case CPU_POST_DEAD:
Viresh Kumar96bbbe42014-03-10 14:53:35 +05302197 __cpufreq_remove_dev_finish(dev, NULL);
Ashok Rajc32b6b82005-10-30 14:59:54 -08002198 break;
Srivatsa S. Bhat5302c3f2013-07-30 04:25:25 +05302199
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08002200 case CPU_DOWN_FAILED:
Viresh Kumar96bbbe42014-03-10 14:53:35 +05302201 __cpufreq_add_dev(dev, NULL);
Ashok Rajc32b6b82005-10-30 14:59:54 -08002202 break;
2203 }
2204 }
2205 return NOTIFY_OK;
2206}
2207
Neal Buckendahl9c36f742010-06-22 22:02:44 -05002208static struct notifier_block __refdata cpufreq_cpu_notifier = {
Viresh Kumarbb176f72013-06-19 14:19:33 +05302209 .notifier_call = cpufreq_cpu_callback,
Ashok Rajc32b6b82005-10-30 14:59:54 -08002210};
Linus Torvalds1da177e2005-04-16 15:20:36 -07002211
2212/*********************************************************************
Lukasz Majewski6f19efc2013-12-20 15:24:49 +01002213 * BOOST *
2214 *********************************************************************/
2215static int cpufreq_boost_set_sw(int state)
2216{
2217 struct cpufreq_frequency_table *freq_table;
2218 struct cpufreq_policy *policy;
2219 int ret = -EINVAL;
2220
2221 list_for_each_entry(policy, &cpufreq_policy_list, policy_list) {
2222 freq_table = cpufreq_frequency_get_table(policy->cpu);
2223 if (freq_table) {
2224 ret = cpufreq_frequency_table_cpuinfo(policy,
2225 freq_table);
2226 if (ret) {
2227 pr_err("%s: Policy frequency update failed\n",
2228 __func__);
2229 break;
2230 }
2231 policy->user_policy.max = policy->max;
2232 __cpufreq_governor(policy, CPUFREQ_GOV_LIMITS);
2233 }
2234 }
2235
2236 return ret;
2237}
2238
2239int cpufreq_boost_trigger_state(int state)
2240{
2241 unsigned long flags;
2242 int ret = 0;
2243
2244 if (cpufreq_driver->boost_enabled == state)
2245 return 0;
2246
2247 write_lock_irqsave(&cpufreq_driver_lock, flags);
2248 cpufreq_driver->boost_enabled = state;
2249 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
2250
2251 ret = cpufreq_driver->set_boost(state);
2252 if (ret) {
2253 write_lock_irqsave(&cpufreq_driver_lock, flags);
2254 cpufreq_driver->boost_enabled = !state;
2255 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
2256
Joe Perchese837f9b2014-03-11 10:03:00 -07002257 pr_err("%s: Cannot %s BOOST\n",
2258 __func__, state ? "enable" : "disable");
Lukasz Majewski6f19efc2013-12-20 15:24:49 +01002259 }
2260
2261 return ret;
2262}
2263
2264int cpufreq_boost_supported(void)
2265{
2266 if (likely(cpufreq_driver))
2267 return cpufreq_driver->boost_supported;
2268
2269 return 0;
2270}
2271EXPORT_SYMBOL_GPL(cpufreq_boost_supported);
2272
2273int cpufreq_boost_enabled(void)
2274{
2275 return cpufreq_driver->boost_enabled;
2276}
2277EXPORT_SYMBOL_GPL(cpufreq_boost_enabled);
2278
2279/*********************************************************************
Linus Torvalds1da177e2005-04-16 15:20:36 -07002280 * REGISTER / UNREGISTER CPUFREQ DRIVER *
2281 *********************************************************************/
2282
2283/**
2284 * cpufreq_register_driver - register a CPU Frequency driver
2285 * @driver_data: A struct cpufreq_driver containing the values#
2286 * submitted by the CPU Frequency driver.
2287 *
Viresh Kumarbb176f72013-06-19 14:19:33 +05302288 * Registers a CPU Frequency driver to this core code. This code
Linus Torvalds1da177e2005-04-16 15:20:36 -07002289 * returns zero on success, -EBUSY when another driver got here first
Dave Jones32ee8c32006-02-28 00:43:23 -05002290 * (and isn't unregistered in the meantime).
Linus Torvalds1da177e2005-04-16 15:20:36 -07002291 *
2292 */
Linus Torvalds221dee22007-02-26 14:55:48 -08002293int cpufreq_register_driver(struct cpufreq_driver *driver_data)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002294{
2295 unsigned long flags;
2296 int ret;
2297
Konrad Rzeszutek Wilka7b422c2012-03-13 19:18:39 -04002298 if (cpufreq_disabled())
2299 return -ENODEV;
2300
Linus Torvalds1da177e2005-04-16 15:20:36 -07002301 if (!driver_data || !driver_data->verify || !driver_data->init ||
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +05302302 !(driver_data->setpolicy || driver_data->target_index ||
Rafael J. Wysocki98322352014-03-19 12:48:30 +01002303 driver_data->target) ||
2304 (driver_data->setpolicy && (driver_data->target_index ||
2305 driver_data->target)))
Linus Torvalds1da177e2005-04-16 15:20:36 -07002306 return -EINVAL;
2307
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02002308 pr_debug("trying to register driver %s\n", driver_data->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002309
2310 if (driver_data->setpolicy)
2311 driver_data->flags |= CPUFREQ_CONST_LOOPS;
2312
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00002313 write_lock_irqsave(&cpufreq_driver_lock, flags);
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02002314 if (cpufreq_driver) {
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00002315 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
Yinghai Lu4dea58062013-09-18 21:05:20 -07002316 return -EEXIST;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002317 }
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02002318 cpufreq_driver = driver_data;
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00002319 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002320
Lukasz Majewski6f19efc2013-12-20 15:24:49 +01002321 if (cpufreq_boost_supported()) {
2322 /*
2323 * Check if driver provides function to enable boost -
2324 * if not, use cpufreq_boost_set_sw as default
2325 */
2326 if (!cpufreq_driver->set_boost)
2327 cpufreq_driver->set_boost = cpufreq_boost_set_sw;
2328
2329 ret = cpufreq_sysfs_create_file(&boost.attr);
2330 if (ret) {
2331 pr_err("%s: cannot register global BOOST sysfs file\n",
Joe Perchese837f9b2014-03-11 10:03:00 -07002332 __func__);
Lukasz Majewski6f19efc2013-12-20 15:24:49 +01002333 goto err_null_driver;
2334 }
2335 }
2336
Kay Sievers8a25a2f2011-12-21 14:29:42 -08002337 ret = subsys_interface_register(&cpufreq_interface);
Jiri Slaby8f5bc2a2011-03-01 17:41:10 +01002338 if (ret)
Lukasz Majewski6f19efc2013-12-20 15:24:49 +01002339 goto err_boost_unreg;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002340
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02002341 if (!(cpufreq_driver->flags & CPUFREQ_STICKY)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002342 int i;
2343 ret = -ENODEV;
2344
2345 /* check for at least one working CPU */
Mike Travis7a6aedf2008-03-25 15:06:53 -07002346 for (i = 0; i < nr_cpu_ids; i++)
2347 if (cpu_possible(i) && per_cpu(cpufreq_cpu_data, i)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002348 ret = 0;
Mike Travis7a6aedf2008-03-25 15:06:53 -07002349 break;
2350 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002351
2352 /* if all ->init() calls failed, unregister */
2353 if (ret) {
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02002354 pr_debug("no CPU initialized for driver %s\n",
Joe Perchese837f9b2014-03-11 10:03:00 -07002355 driver_data->name);
Kay Sievers8a25a2f2011-12-21 14:29:42 -08002356 goto err_if_unreg;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002357 }
2358 }
2359
Jiri Slaby8f5bc2a2011-03-01 17:41:10 +01002360 register_hotcpu_notifier(&cpufreq_cpu_notifier);
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02002361 pr_debug("driver %s up and running\n", driver_data->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002362
Jiri Slaby8f5bc2a2011-03-01 17:41:10 +01002363 return 0;
Kay Sievers8a25a2f2011-12-21 14:29:42 -08002364err_if_unreg:
2365 subsys_interface_unregister(&cpufreq_interface);
Lukasz Majewski6f19efc2013-12-20 15:24:49 +01002366err_boost_unreg:
2367 if (cpufreq_boost_supported())
2368 cpufreq_sysfs_remove_file(&boost.attr);
Jiri Slaby8f5bc2a2011-03-01 17:41:10 +01002369err_null_driver:
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00002370 write_lock_irqsave(&cpufreq_driver_lock, flags);
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02002371 cpufreq_driver = NULL;
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00002372 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
Dave Jones4d34a672008-02-07 16:33:49 -05002373 return ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002374}
2375EXPORT_SYMBOL_GPL(cpufreq_register_driver);
2376
Linus Torvalds1da177e2005-04-16 15:20:36 -07002377/**
2378 * cpufreq_unregister_driver - unregister the current CPUFreq driver
2379 *
Viresh Kumarbb176f72013-06-19 14:19:33 +05302380 * Unregister the current CPUFreq driver. Only call this if you have
Linus Torvalds1da177e2005-04-16 15:20:36 -07002381 * the right to do so, i.e. if you have succeeded in initialising before!
2382 * Returns zero if successful, and -EINVAL if the cpufreq_driver is
2383 * currently not initialised.
2384 */
Linus Torvalds221dee22007-02-26 14:55:48 -08002385int cpufreq_unregister_driver(struct cpufreq_driver *driver)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002386{
2387 unsigned long flags;
2388
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02002389 if (!cpufreq_driver || (driver != cpufreq_driver))
Linus Torvalds1da177e2005-04-16 15:20:36 -07002390 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002391
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02002392 pr_debug("unregistering driver %s\n", driver->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002393
Kay Sievers8a25a2f2011-12-21 14:29:42 -08002394 subsys_interface_unregister(&cpufreq_interface);
Lukasz Majewski6f19efc2013-12-20 15:24:49 +01002395 if (cpufreq_boost_supported())
2396 cpufreq_sysfs_remove_file(&boost.attr);
2397
Chandra Seetharaman65edc682006-06-27 02:54:08 -07002398 unregister_hotcpu_notifier(&cpufreq_cpu_notifier);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002399
Viresh Kumar6eed9402013-08-06 22:53:11 +05302400 down_write(&cpufreq_rwsem);
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00002401 write_lock_irqsave(&cpufreq_driver_lock, flags);
Viresh Kumar6eed9402013-08-06 22:53:11 +05302402
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02002403 cpufreq_driver = NULL;
Viresh Kumar6eed9402013-08-06 22:53:11 +05302404
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00002405 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
Viresh Kumar6eed9402013-08-06 22:53:11 +05302406 up_write(&cpufreq_rwsem);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002407
2408 return 0;
2409}
2410EXPORT_SYMBOL_GPL(cpufreq_unregister_driver);
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08002411
2412static int __init cpufreq_core_init(void)
2413{
Konrad Rzeszutek Wilka7b422c2012-03-13 19:18:39 -04002414 if (cpufreq_disabled())
2415 return -ENODEV;
2416
Viresh Kumar2361be22013-05-17 16:09:09 +05302417 cpufreq_global_kobject = kobject_create();
Thomas Renninger8aa84ad2009-07-24 15:25:05 +02002418 BUG_ON(!cpufreq_global_kobject);
2419
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08002420 return 0;
2421}
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08002422core_initcall(cpufreq_core_init);