blob: e3aa9deb40d912a77235dcc140dc10bffd415932 [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()) {
Viresh Kumar3de9bde2013-08-06 22:53:13 +0530942 if ((ret = __cpufreq_governor(policy, CPUFREQ_GOV_START)) ||
943 (ret = __cpufreq_governor(policy, CPUFREQ_GOV_LIMITS))) {
944 pr_err("%s: Failed to start governor\n", __func__);
945 return ret;
946 }
Viresh Kumar820c6ca2013-04-22 00:48:03 +0200947 }
Viresh Kumarfcf80582013-01-29 14:39:08 +0000948
Viresh Kumar42f921a2013-12-20 21:26:02 +0530949 return sysfs_create_link(&dev->kobj, &policy->kobj, "cpufreq");
Viresh Kumarfcf80582013-01-29 14:39:08 +0000950}
951#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700952
Srivatsa S. Bhat84148092013-07-30 04:25:10 +0530953static struct cpufreq_policy *cpufreq_policy_restore(unsigned int cpu)
954{
955 struct cpufreq_policy *policy;
956 unsigned long flags;
957
Lan Tianyu44871c92013-09-11 15:05:05 +0800958 read_lock_irqsave(&cpufreq_driver_lock, flags);
Srivatsa S. Bhat84148092013-07-30 04:25:10 +0530959
960 policy = per_cpu(cpufreq_cpu_data_fallback, cpu);
961
Lan Tianyu44871c92013-09-11 15:05:05 +0800962 read_unlock_irqrestore(&cpufreq_driver_lock, flags);
Srivatsa S. Bhat84148092013-07-30 04:25:10 +0530963
viresh kumar6e2c89d2014-03-04 11:43:59 +0800964 policy->governor = NULL;
965
Srivatsa S. Bhat84148092013-07-30 04:25:10 +0530966 return policy;
967}
968
Srivatsa S. Bhate9698cc2013-07-30 04:24:11 +0530969static struct cpufreq_policy *cpufreq_policy_alloc(void)
970{
971 struct cpufreq_policy *policy;
972
973 policy = kzalloc(sizeof(*policy), GFP_KERNEL);
974 if (!policy)
975 return NULL;
976
977 if (!alloc_cpumask_var(&policy->cpus, GFP_KERNEL))
978 goto err_free_policy;
979
980 if (!zalloc_cpumask_var(&policy->related_cpus, GFP_KERNEL))
981 goto err_free_cpumask;
982
Lukasz Majewskic88a1f82013-08-06 22:53:08 +0530983 INIT_LIST_HEAD(&policy->policy_list);
viresh kumarad7722d2013-10-18 19:10:15 +0530984 init_rwsem(&policy->rwsem);
985
Srivatsa S. Bhate9698cc2013-07-30 04:24:11 +0530986 return policy;
987
988err_free_cpumask:
989 free_cpumask_var(policy->cpus);
990err_free_policy:
991 kfree(policy);
992
993 return NULL;
994}
995
Viresh Kumar42f921a2013-12-20 21:26:02 +0530996static void cpufreq_policy_put_kobj(struct cpufreq_policy *policy)
997{
998 struct kobject *kobj;
999 struct completion *cmp;
1000
Viresh Kumarfcd7af92014-01-07 07:10:10 +05301001 blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
1002 CPUFREQ_REMOVE_POLICY, policy);
1003
Viresh Kumar42f921a2013-12-20 21:26:02 +05301004 down_read(&policy->rwsem);
1005 kobj = &policy->kobj;
1006 cmp = &policy->kobj_unregister;
1007 up_read(&policy->rwsem);
1008 kobject_put(kobj);
1009
1010 /*
1011 * We need to make sure that the underlying kobj is
1012 * actually not referenced anymore by anybody before we
1013 * proceed with unloading.
1014 */
1015 pr_debug("waiting for dropping of refcount\n");
1016 wait_for_completion(cmp);
1017 pr_debug("wait complete\n");
1018}
1019
Srivatsa S. Bhate9698cc2013-07-30 04:24:11 +05301020static void cpufreq_policy_free(struct cpufreq_policy *policy)
1021{
1022 free_cpumask_var(policy->related_cpus);
1023 free_cpumask_var(policy->cpus);
1024 kfree(policy);
1025}
1026
Srivatsa S. Bhat0d66b912013-09-12 01:42:59 +05301027static void update_policy_cpu(struct cpufreq_policy *policy, unsigned int cpu)
1028{
Srivatsa S. Bhat99ec8992013-09-12 17:29:09 +05301029 if (WARN_ON(cpu == policy->cpu))
Srivatsa S. Bhatcb38ed52013-09-12 01:43:42 +05301030 return;
1031
viresh kumarad7722d2013-10-18 19:10:15 +05301032 down_write(&policy->rwsem);
Viresh Kumar8efd5762013-09-17 10:22:11 +05301033
Srivatsa S. Bhat0d66b912013-09-12 01:42:59 +05301034 policy->last_cpu = policy->cpu;
1035 policy->cpu = cpu;
1036
viresh kumarad7722d2013-10-18 19:10:15 +05301037 up_write(&policy->rwsem);
Viresh Kumar8efd5762013-09-17 10:22:11 +05301038
Srivatsa S. Bhat0d66b912013-09-12 01:42:59 +05301039 blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
1040 CPUFREQ_UPDATE_POLICY_CPU, policy);
1041}
1042
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301043static int __cpufreq_add_dev(struct device *dev, struct subsys_interface *sif)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001044{
Viresh Kumarfcf80582013-01-29 14:39:08 +00001045 unsigned int j, cpu = dev->id;
Viresh Kumar65922462013-02-07 10:56:03 +05301046 int ret = -ENOMEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001047 struct cpufreq_policy *policy;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001048 unsigned long flags;
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301049 bool recover_policy = cpufreq_suspended;
Prarit Bhargava90e41ba2009-11-12 09:18:46 -05001050#ifdef CONFIG_HOTPLUG_CPU
Viresh Kumar1b274292013-08-20 12:08:26 +05301051 struct cpufreq_policy *tpolicy;
Prarit Bhargava90e41ba2009-11-12 09:18:46 -05001052#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07001053
Ashok Rajc32b6b82005-10-30 14:59:54 -08001054 if (cpu_is_offline(cpu))
1055 return 0;
1056
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02001057 pr_debug("adding CPU %u\n", cpu);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001058
1059#ifdef CONFIG_SMP
1060 /* check whether a different CPU already registered this
1061 * CPU because it is in the same boat. */
1062 policy = cpufreq_cpu_get(cpu);
1063 if (unlikely(policy)) {
Dave Jones8ff69732006-03-05 03:37:23 -05001064 cpufreq_cpu_put(policy);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001065 return 0;
1066 }
Li Zhong5025d622013-08-21 01:31:08 +02001067#endif
Viresh Kumarfcf80582013-01-29 14:39:08 +00001068
Viresh Kumar6eed9402013-08-06 22:53:11 +05301069 if (!down_read_trylock(&cpufreq_rwsem))
1070 return 0;
1071
Viresh Kumarfcf80582013-01-29 14:39:08 +00001072#ifdef CONFIG_HOTPLUG_CPU
1073 /* Check if this cpu was hot-unplugged earlier and has siblings */
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00001074 read_lock_irqsave(&cpufreq_driver_lock, flags);
Viresh Kumar1b274292013-08-20 12:08:26 +05301075 list_for_each_entry(tpolicy, &cpufreq_policy_list, policy_list) {
1076 if (cpumask_test_cpu(cpu, tpolicy->related_cpus)) {
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00001077 read_unlock_irqrestore(&cpufreq_driver_lock, flags);
Viresh Kumar42f921a2013-12-20 21:26:02 +05301078 ret = cpufreq_add_policy_cpu(tpolicy, cpu, dev);
Viresh Kumar6eed9402013-08-06 22:53:11 +05301079 up_read(&cpufreq_rwsem);
1080 return ret;
Viresh Kumar2eaa3e22013-02-07 10:55:00 +05301081 }
Viresh Kumarfcf80582013-01-29 14:39:08 +00001082 }
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00001083 read_unlock_irqrestore(&cpufreq_driver_lock, flags);
Viresh Kumarfcf80582013-01-29 14:39:08 +00001084#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07001085
Rafael J. Wysocki72368d12013-12-27 01:07:11 +01001086 /*
1087 * Restore the saved policy when doing light-weight init and fall back
1088 * to the full init if that fails.
1089 */
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301090 policy = recover_policy ? cpufreq_policy_restore(cpu) : NULL;
Rafael J. Wysocki72368d12013-12-27 01:07:11 +01001091 if (!policy) {
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301092 recover_policy = false;
Srivatsa S. Bhat84148092013-07-30 04:25:10 +05301093 policy = cpufreq_policy_alloc();
Rafael J. Wysocki72368d12013-12-27 01:07:11 +01001094 if (!policy)
1095 goto nomem_out;
1096 }
Srivatsa S. Bhat0d66b912013-09-12 01:42:59 +05301097
1098 /*
1099 * In the resume path, since we restore a saved policy, the assignment
1100 * to policy->cpu is like an update of the existing policy, rather than
1101 * the creation of a brand new one. So we need to perform this update
1102 * by invoking update_policy_cpu().
1103 */
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301104 if (recover_policy && cpu != policy->cpu)
Srivatsa S. Bhat0d66b912013-09-12 01:42:59 +05301105 update_policy_cpu(policy, cpu);
1106 else
1107 policy->cpu = cpu;
1108
Rusty Russell835481d2009-01-04 05:18:06 -08001109 cpumask_copy(policy->cpus, cpumask_of(cpu));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001110
Linus Torvalds1da177e2005-04-16 15:20:36 -07001111 init_completion(&policy->kobj_unregister);
David Howells65f27f32006-11-22 14:55:48 +00001112 INIT_WORK(&policy->update, handle_update);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001113
1114 /* call driver. From then on the cpufreq must be able
1115 * to accept all calls to ->verify and ->setpolicy for this CPU
1116 */
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02001117 ret = cpufreq_driver->init(policy);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001118 if (ret) {
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02001119 pr_debug("initialization failed\n");
Viresh Kumar2eaa3e22013-02-07 10:55:00 +05301120 goto err_set_policy_cpu;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001121 }
Viresh Kumar643ae6e2013-01-12 05:14:38 +00001122
Viresh Kumar5a7e56a2014-03-04 11:44:00 +08001123 /* related cpus should atleast have policy->cpus */
1124 cpumask_or(policy->related_cpus, policy->related_cpus, policy->cpus);
1125
1126 /*
1127 * affected cpus must always be the one, which are online. We aren't
1128 * managing offline cpus here.
1129 */
1130 cpumask_and(policy->cpus, policy->cpus, cpu_online_mask);
1131
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301132 if (!recover_policy) {
Viresh Kumar5a7e56a2014-03-04 11:44:00 +08001133 policy->user_policy.min = policy->min;
1134 policy->user_policy.max = policy->max;
1135 }
1136
Viresh Kumar4e97b632014-03-04 11:44:01 +08001137 down_write(&policy->rwsem);
Viresh Kumar652ed952014-01-09 20:38:43 +05301138 write_lock_irqsave(&cpufreq_driver_lock, flags);
1139 for_each_cpu(j, policy->cpus)
1140 per_cpu(cpufreq_cpu_data, j) = policy;
1141 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
1142
Rafael J. Wysocki2ed99e32014-03-12 21:49:33 +01001143 if (cpufreq_driver->get && !cpufreq_driver->setpolicy) {
Viresh Kumarda60ce92013-10-03 20:28:30 +05301144 policy->cur = cpufreq_driver->get(policy->cpu);
1145 if (!policy->cur) {
1146 pr_err("%s: ->get() failed\n", __func__);
1147 goto err_get_freq;
1148 }
1149 }
1150
Viresh Kumard3916692013-12-03 11:20:46 +05301151 /*
1152 * Sometimes boot loaders set CPU frequency to a value outside of
1153 * frequency table present with cpufreq core. In such cases CPU might be
1154 * unstable if it has to run on that frequency for long duration of time
1155 * and so its better to set it to a frequency which is specified in
1156 * freq-table. This also makes cpufreq stats inconsistent as
1157 * cpufreq-stats would fail to register because current frequency of CPU
1158 * isn't found in freq-table.
1159 *
1160 * Because we don't want this change to effect boot process badly, we go
1161 * for the next freq which is >= policy->cur ('cur' must be set by now,
1162 * otherwise we will end up setting freq to lowest of the table as 'cur'
1163 * is initialized to zero).
1164 *
1165 * We are passing target-freq as "policy->cur - 1" otherwise
1166 * __cpufreq_driver_target() would simply fail, as policy->cur will be
1167 * equal to target-freq.
1168 */
1169 if ((cpufreq_driver->flags & CPUFREQ_NEED_INITIAL_FREQ_CHECK)
1170 && has_target()) {
1171 /* Are we running at unknown frequency ? */
1172 ret = cpufreq_frequency_table_get_index(policy, policy->cur);
1173 if (ret == -EINVAL) {
1174 /* Warn user and fix it */
1175 pr_warn("%s: CPU%d: Running at unlisted freq: %u KHz\n",
1176 __func__, policy->cpu, policy->cur);
1177 ret = __cpufreq_driver_target(policy, policy->cur - 1,
1178 CPUFREQ_RELATION_L);
1179
1180 /*
1181 * Reaching here after boot in a few seconds may not
1182 * mean that system will remain stable at "unknown"
1183 * frequency for longer duration. Hence, a BUG_ON().
1184 */
1185 BUG_ON(ret);
1186 pr_warn("%s: CPU%d: Unlisted initial frequency changed to: %u KHz\n",
1187 __func__, policy->cpu, policy->cur);
1188 }
1189 }
1190
Thomas Renningera1531ac2008-07-29 22:32:58 -07001191 blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
1192 CPUFREQ_START, policy);
1193
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301194 if (!recover_policy) {
Viresh Kumar308b60e2013-07-31 14:35:14 +02001195 ret = cpufreq_add_dev_interface(policy, dev);
Srivatsa S. Bhata82fab22013-07-30 04:24:49 +05301196 if (ret)
1197 goto err_out_unregister;
Viresh Kumarfcd7af92014-01-07 07:10:10 +05301198 blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
1199 CPUFREQ_CREATE_POLICY, policy);
Srivatsa S. Bhata82fab22013-07-30 04:24:49 +05301200 }
Dave Jones8ff69732006-03-05 03:37:23 -05001201
Viresh Kumar9515f4d2013-08-20 12:08:23 +05301202 write_lock_irqsave(&cpufreq_driver_lock, flags);
1203 list_add(&policy->policy_list, &cpufreq_policy_list);
1204 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
1205
Srivatsa S. Bhate18f1682013-07-30 04:24:23 +05301206 cpufreq_init_policy(policy);
1207
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301208 if (!recover_policy) {
Viresh Kumar08fd8c1c2013-12-24 07:11:01 +05301209 policy->user_policy.policy = policy->policy;
1210 policy->user_policy.governor = policy->governor;
1211 }
Viresh Kumar4e97b632014-03-04 11:44:01 +08001212 up_write(&policy->rwsem);
Viresh Kumar08fd8c1c2013-12-24 07:11:01 +05301213
Greg Kroah-Hartman038c5b32007-12-17 15:54:39 -04001214 kobject_uevent(&policy->kobj, KOBJ_ADD);
Viresh Kumar6eed9402013-08-06 22:53:11 +05301215 up_read(&cpufreq_rwsem);
1216
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02001217 pr_debug("initialization complete\n");
Dave Jones87c32272006-03-29 01:48:37 -05001218
Linus Torvalds1da177e2005-04-16 15:20:36 -07001219 return 0;
1220
Linus Torvalds1da177e2005-04-16 15:20:36 -07001221err_out_unregister:
Viresh Kumar652ed952014-01-09 20:38:43 +05301222err_get_freq:
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00001223 write_lock_irqsave(&cpufreq_driver_lock, flags);
Viresh Kumar474deff2013-08-20 12:08:25 +05301224 for_each_cpu(j, policy->cpus)
Mike Travis7a6aedf2008-03-25 15:06:53 -07001225 per_cpu(cpufreq_cpu_data, j) = NULL;
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00001226 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001227
Viresh Kumarda60ce92013-10-03 20:28:30 +05301228 if (cpufreq_driver->exit)
1229 cpufreq_driver->exit(policy);
Viresh Kumar2eaa3e22013-02-07 10:55:00 +05301230err_set_policy_cpu:
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301231 if (recover_policy) {
Rafael J. Wysocki72368d12013-12-27 01:07:11 +01001232 /* Do not leave stale fallback data behind. */
1233 per_cpu(cpufreq_cpu_data_fallback, cpu) = NULL;
Viresh Kumar42f921a2013-12-20 21:26:02 +05301234 cpufreq_policy_put_kobj(policy);
Rafael J. Wysocki72368d12013-12-27 01:07:11 +01001235 }
Srivatsa S. Bhate9698cc2013-07-30 04:24:11 +05301236 cpufreq_policy_free(policy);
Viresh Kumar42f921a2013-12-20 21:26:02 +05301237
Linus Torvalds1da177e2005-04-16 15:20:36 -07001238nomem_out:
Viresh Kumar6eed9402013-08-06 22:53:11 +05301239 up_read(&cpufreq_rwsem);
1240
Linus Torvalds1da177e2005-04-16 15:20:36 -07001241 return ret;
1242}
1243
Srivatsa S. Bhata82fab22013-07-30 04:24:49 +05301244/**
1245 * cpufreq_add_dev - add a CPU device
1246 *
1247 * Adds the cpufreq interface for a CPU device.
1248 *
1249 * The Oracle says: try running cpufreq registration/unregistration concurrently
1250 * with with cpu hotplugging and all hell will break loose. Tried to clean this
1251 * mess up, but more thorough testing is needed. - Mathieu
1252 */
1253static int cpufreq_add_dev(struct device *dev, struct subsys_interface *sif)
1254{
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301255 return __cpufreq_add_dev(dev, sif);
Srivatsa S. Bhata82fab22013-07-30 04:24:49 +05301256}
1257
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301258static int cpufreq_nominate_new_policy_cpu(struct cpufreq_policy *policy,
Viresh Kumar42f921a2013-12-20 21:26:02 +05301259 unsigned int old_cpu)
Srivatsa S. Bhatf9ba6802013-07-30 04:24:36 +05301260{
1261 struct device *cpu_dev;
Srivatsa S. Bhatf9ba6802013-07-30 04:24:36 +05301262 int ret;
1263
1264 /* first sibling now owns the new sysfs dir */
Viresh Kumar9c8f1ee2013-09-12 17:06:33 +05301265 cpu_dev = get_cpu_device(cpumask_any_but(policy->cpus, old_cpu));
Srivatsa S. Bhata82fab22013-07-30 04:24:49 +05301266
Srivatsa S. Bhatf9ba6802013-07-30 04:24:36 +05301267 sysfs_remove_link(&cpu_dev->kobj, "cpufreq");
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301268 ret = kobject_move(&policy->kobj, &cpu_dev->kobj);
Srivatsa S. Bhatf9ba6802013-07-30 04:24:36 +05301269 if (ret) {
Joe Perchese837f9b2014-03-11 10:03:00 -07001270 pr_err("%s: Failed to move kobj: %d\n", __func__, ret);
Srivatsa S. Bhatf9ba6802013-07-30 04:24:36 +05301271
viresh kumarad7722d2013-10-18 19:10:15 +05301272 down_write(&policy->rwsem);
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301273 cpumask_set_cpu(old_cpu, policy->cpus);
viresh kumarad7722d2013-10-18 19:10:15 +05301274 up_write(&policy->rwsem);
Srivatsa S. Bhatf9ba6802013-07-30 04:24:36 +05301275
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301276 ret = sysfs_create_link(&cpu_dev->kobj, &policy->kobj,
Srivatsa S. Bhatf9ba6802013-07-30 04:24:36 +05301277 "cpufreq");
1278
1279 return -EINVAL;
1280 }
1281
1282 return cpu_dev->id;
1283}
1284
Srivatsa S. Bhatcedb70a2013-09-07 01:23:09 +05301285static int __cpufreq_remove_dev_prepare(struct device *dev,
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301286 struct subsys_interface *sif)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001287{
Srivatsa S. Bhatf9ba6802013-07-30 04:24:36 +05301288 unsigned int cpu = dev->id, cpus;
Viresh Kumar3de9bde2013-08-06 22:53:13 +05301289 int new_cpu, ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001290 unsigned long flags;
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301291 struct cpufreq_policy *policy;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001292
Viresh Kumarb8eed8a2013-01-14 13:23:03 +00001293 pr_debug("%s: unregistering CPU %u\n", __func__, cpu);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001294
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00001295 write_lock_irqsave(&cpufreq_driver_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001296
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301297 policy = per_cpu(cpufreq_cpu_data, cpu);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001298
Srivatsa S. Bhat84148092013-07-30 04:25:10 +05301299 /* Save the policy somewhere when doing a light-weight tear-down */
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301300 if (cpufreq_suspended)
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301301 per_cpu(cpufreq_cpu_data_fallback, cpu) = policy;
Srivatsa S. Bhat84148092013-07-30 04:25:10 +05301302
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00001303 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001304
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301305 if (!policy) {
Viresh Kumarb8eed8a2013-01-14 13:23:03 +00001306 pr_debug("%s: No cpu_data found\n", __func__);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001307 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001308 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001309
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +05301310 if (has_target()) {
Viresh Kumar3de9bde2013-08-06 22:53:13 +05301311 ret = __cpufreq_governor(policy, CPUFREQ_GOV_STOP);
1312 if (ret) {
1313 pr_err("%s: Failed to stop governor\n", __func__);
1314 return ret;
1315 }
1316 }
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08001317
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02001318 if (!cpufreq_driver->setpolicy)
Dirk Brandewiefa69e332013-02-06 09:02:11 -08001319 strncpy(per_cpu(cpufreq_cpu_governor, cpu),
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301320 policy->governor->name, CPUFREQ_NAME_LEN);
Jacob Shin27ecddc2011-04-27 13:32:11 -05001321
viresh kumarad7722d2013-10-18 19:10:15 +05301322 down_read(&policy->rwsem);
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301323 cpus = cpumask_weight(policy->cpus);
viresh kumarad7722d2013-10-18 19:10:15 +05301324 up_read(&policy->rwsem);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001325
Srivatsa S. Bhat61173f22013-09-12 01:43:25 +05301326 if (cpu != policy->cpu) {
viresh kumar6964d912014-02-17 14:52:11 +05301327 sysfs_remove_link(&dev->kobj, "cpufreq");
Viresh Kumar73bf0fc2013-02-05 22:21:14 +01001328 } else if (cpus > 1) {
Viresh Kumar42f921a2013-12-20 21:26:02 +05301329 new_cpu = cpufreq_nominate_new_policy_cpu(policy, cpu);
Srivatsa S. Bhatf9ba6802013-07-30 04:24:36 +05301330 if (new_cpu >= 0) {
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301331 update_policy_cpu(policy, new_cpu);
Srivatsa S. Bhata82fab22013-07-30 04:24:49 +05301332
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301333 if (!cpufreq_suspended) {
Viresh Kumar75949c92013-10-02 14:13:13 +05301334 pr_debug("%s: policy Kobject moved to cpu: %d from: %d\n",
Joe Perchese837f9b2014-03-11 10:03:00 -07001335 __func__, new_cpu, cpu);
Srivatsa S. Bhata82fab22013-07-30 04:24:49 +05301336 }
Viresh Kumarb8eed8a2013-01-14 13:23:03 +00001337 }
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08001338 }
Venki Pallipadiec282972007-03-26 12:03:19 -07001339
Srivatsa S. Bhatcedb70a2013-09-07 01:23:09 +05301340 return 0;
1341}
1342
1343static int __cpufreq_remove_dev_finish(struct device *dev,
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301344 struct subsys_interface *sif)
Srivatsa S. Bhatcedb70a2013-09-07 01:23:09 +05301345{
1346 unsigned int cpu = dev->id, cpus;
1347 int ret;
1348 unsigned long flags;
1349 struct cpufreq_policy *policy;
Srivatsa S. Bhatcedb70a2013-09-07 01:23:09 +05301350
1351 read_lock_irqsave(&cpufreq_driver_lock, flags);
1352 policy = per_cpu(cpufreq_cpu_data, cpu);
1353 read_unlock_irqrestore(&cpufreq_driver_lock, flags);
1354
1355 if (!policy) {
1356 pr_debug("%s: No cpu_data found\n", __func__);
1357 return -EINVAL;
1358 }
1359
viresh kumarad7722d2013-10-18 19:10:15 +05301360 down_write(&policy->rwsem);
Srivatsa S. Bhatcedb70a2013-09-07 01:23:09 +05301361 cpus = cpumask_weight(policy->cpus);
Viresh Kumar9c8f1ee2013-09-12 17:06:33 +05301362
1363 if (cpus > 1)
1364 cpumask_clear_cpu(cpu, policy->cpus);
viresh kumarad7722d2013-10-18 19:10:15 +05301365 up_write(&policy->rwsem);
Srivatsa S. Bhatcedb70a2013-09-07 01:23:09 +05301366
Viresh Kumarb8eed8a2013-01-14 13:23:03 +00001367 /* If cpu is last user of policy, free policy */
1368 if (cpus == 1) {
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +05301369 if (has_target()) {
Viresh Kumar3de9bde2013-08-06 22:53:13 +05301370 ret = __cpufreq_governor(policy,
1371 CPUFREQ_GOV_POLICY_EXIT);
1372 if (ret) {
1373 pr_err("%s: Failed to exit governor\n",
Joe Perchese837f9b2014-03-11 10:03:00 -07001374 __func__);
Viresh Kumar3de9bde2013-08-06 22:53:13 +05301375 return ret;
1376 }
Viresh Kumaredab2fb2013-08-20 12:08:22 +05301377 }
Rafael J. Wysocki2a998592013-07-30 00:32:00 +02001378
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301379 if (!cpufreq_suspended)
Viresh Kumar42f921a2013-12-20 21:26:02 +05301380 cpufreq_policy_put_kobj(policy);
Srivatsa S. Bhat84148092013-07-30 04:25:10 +05301381
1382 /*
1383 * Perform the ->exit() even during light-weight tear-down,
1384 * since this is a core component, and is essential for the
1385 * subsequent light-weight ->init() to succeed.
Viresh Kumarb8eed8a2013-01-14 13:23:03 +00001386 */
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02001387 if (cpufreq_driver->exit)
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301388 cpufreq_driver->exit(policy);
Viresh Kumarb8eed8a2013-01-14 13:23:03 +00001389
Viresh Kumar9515f4d2013-08-20 12:08:23 +05301390 /* Remove policy from list of active policies */
1391 write_lock_irqsave(&cpufreq_driver_lock, flags);
1392 list_del(&policy->policy_list);
1393 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
1394
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301395 if (!cpufreq_suspended)
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301396 cpufreq_policy_free(policy);
Rafael J. Wysocki2a998592013-07-30 00:32:00 +02001397 } else {
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +05301398 if (has_target()) {
Viresh Kumar3de9bde2013-08-06 22:53:13 +05301399 if ((ret = __cpufreq_governor(policy, CPUFREQ_GOV_START)) ||
1400 (ret = __cpufreq_governor(policy, CPUFREQ_GOV_LIMITS))) {
1401 pr_err("%s: Failed to start governor\n",
Joe Perchese837f9b2014-03-11 10:03:00 -07001402 __func__);
Viresh Kumar3de9bde2013-08-06 22:53:13 +05301403 return ret;
1404 }
Rafael J. Wysocki2a998592013-07-30 00:32:00 +02001405 }
Viresh Kumarb8eed8a2013-01-14 13:23:03 +00001406 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001407
Viresh Kumar474deff2013-08-20 12:08:25 +05301408 per_cpu(cpufreq_cpu_data, cpu) = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001409 return 0;
1410}
1411
Srivatsa S. Bhatcedb70a2013-09-07 01:23:09 +05301412/**
Viresh Kumar27a862e2013-10-02 14:13:14 +05301413 * cpufreq_remove_dev - remove a CPU device
Srivatsa S. Bhatcedb70a2013-09-07 01:23:09 +05301414 *
1415 * Removes the cpufreq interface for a CPU device.
Srivatsa S. Bhatcedb70a2013-09-07 01:23:09 +05301416 */
Kay Sievers8a25a2f2011-12-21 14:29:42 -08001417static int cpufreq_remove_dev(struct device *dev, struct subsys_interface *sif)
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08001418{
Kay Sievers8a25a2f2011-12-21 14:29:42 -08001419 unsigned int cpu = dev->id;
Viresh Kumar27a862e2013-10-02 14:13:14 +05301420 int ret;
Venki Pallipadiec282972007-03-26 12:03:19 -07001421
1422 if (cpu_is_offline(cpu))
1423 return 0;
1424
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301425 ret = __cpufreq_remove_dev_prepare(dev, sif);
Viresh Kumar27a862e2013-10-02 14:13:14 +05301426
1427 if (!ret)
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301428 ret = __cpufreq_remove_dev_finish(dev, sif);
Viresh Kumar27a862e2013-10-02 14:13:14 +05301429
1430 return ret;
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08001431}
1432
David Howells65f27f32006-11-22 14:55:48 +00001433static void handle_update(struct work_struct *work)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001434{
David Howells65f27f32006-11-22 14:55:48 +00001435 struct cpufreq_policy *policy =
1436 container_of(work, struct cpufreq_policy, update);
1437 unsigned int cpu = policy->cpu;
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02001438 pr_debug("handle_update for cpu %u called\n", cpu);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001439 cpufreq_update_policy(cpu);
1440}
1441
1442/**
Viresh Kumarbb176f72013-06-19 14:19:33 +05301443 * cpufreq_out_of_sync - If actual and saved CPU frequency differs, we're
1444 * in deep trouble.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001445 * @cpu: cpu number
1446 * @old_freq: CPU frequency the kernel thinks the CPU runs at
1447 * @new_freq: CPU frequency the CPU actually runs at
1448 *
Dave Jones29464f22009-01-18 01:37:11 -05001449 * We adjust to current frequency first, and need to clean up later.
1450 * So either call to cpufreq_update_policy() or schedule handle_update()).
Linus Torvalds1da177e2005-04-16 15:20:36 -07001451 */
Gautham R Shenoye08f5f52006-10-26 16:20:58 +05301452static void cpufreq_out_of_sync(unsigned int cpu, unsigned int old_freq,
1453 unsigned int new_freq)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001454{
Viresh Kumarb43a7ff2013-03-24 11:56:43 +05301455 struct cpufreq_policy *policy;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001456 struct cpufreq_freqs freqs;
Viresh Kumarb43a7ff2013-03-24 11:56:43 +05301457 unsigned long flags;
1458
Joe Perchese837f9b2014-03-11 10:03:00 -07001459 pr_debug("Warning: CPU frequency out of sync: cpufreq and timing core thinks of %u, is %u kHz\n",
1460 old_freq, new_freq);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001461
Linus Torvalds1da177e2005-04-16 15:20:36 -07001462 freqs.old = old_freq;
1463 freqs.new = new_freq;
Viresh Kumarb43a7ff2013-03-24 11:56:43 +05301464
1465 read_lock_irqsave(&cpufreq_driver_lock, flags);
1466 policy = per_cpu(cpufreq_cpu_data, cpu);
1467 read_unlock_irqrestore(&cpufreq_driver_lock, flags);
1468
1469 cpufreq_notify_transition(policy, &freqs, CPUFREQ_PRECHANGE);
1470 cpufreq_notify_transition(policy, &freqs, CPUFREQ_POSTCHANGE);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001471}
1472
Dave Jones32ee8c32006-02-28 00:43:23 -05001473/**
Dhaval Giani4ab70df2006-12-13 14:49:15 +05301474 * cpufreq_quick_get - get the CPU frequency (in kHz) from policy->cur
Venkatesh Pallipadi95235ca2005-12-02 10:43:20 -08001475 * @cpu: CPU number
1476 *
1477 * This is the last known freq, without actually getting it from the driver.
1478 * Return value will be same as what is shown in scaling_cur_freq in sysfs.
1479 */
1480unsigned int cpufreq_quick_get(unsigned int cpu)
1481{
Dirk Brandewie9e21ba82013-02-06 09:02:08 -08001482 struct cpufreq_policy *policy;
Gautham R Shenoye08f5f52006-10-26 16:20:58 +05301483 unsigned int ret_freq = 0;
Venkatesh Pallipadi95235ca2005-12-02 10:43:20 -08001484
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02001485 if (cpufreq_driver && cpufreq_driver->setpolicy && cpufreq_driver->get)
1486 return cpufreq_driver->get(cpu);
Dirk Brandewie9e21ba82013-02-06 09:02:08 -08001487
1488 policy = cpufreq_cpu_get(cpu);
Venkatesh Pallipadi95235ca2005-12-02 10:43:20 -08001489 if (policy) {
Gautham R Shenoye08f5f52006-10-26 16:20:58 +05301490 ret_freq = policy->cur;
Venkatesh Pallipadi95235ca2005-12-02 10:43:20 -08001491 cpufreq_cpu_put(policy);
1492 }
1493
Dave Jones4d34a672008-02-07 16:33:49 -05001494 return ret_freq;
Venkatesh Pallipadi95235ca2005-12-02 10:43:20 -08001495}
1496EXPORT_SYMBOL(cpufreq_quick_get);
1497
Jesse Barnes3d737102011-06-28 10:59:12 -07001498/**
1499 * cpufreq_quick_get_max - get the max reported CPU frequency for this CPU
1500 * @cpu: CPU number
1501 *
1502 * Just return the max possible frequency for a given CPU.
1503 */
1504unsigned int cpufreq_quick_get_max(unsigned int cpu)
1505{
1506 struct cpufreq_policy *policy = cpufreq_cpu_get(cpu);
1507 unsigned int ret_freq = 0;
1508
1509 if (policy) {
1510 ret_freq = policy->max;
1511 cpufreq_cpu_put(policy);
1512 }
1513
1514 return ret_freq;
1515}
1516EXPORT_SYMBOL(cpufreq_quick_get_max);
1517
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08001518static unsigned int __cpufreq_get(unsigned int cpu)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001519{
Mike Travis7a6aedf2008-03-25 15:06:53 -07001520 struct cpufreq_policy *policy = per_cpu(cpufreq_cpu_data, cpu);
Gautham R Shenoye08f5f52006-10-26 16:20:58 +05301521 unsigned int ret_freq = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001522
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02001523 if (!cpufreq_driver->get)
Dave Jones4d34a672008-02-07 16:33:49 -05001524 return ret_freq;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001525
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02001526 ret_freq = cpufreq_driver->get(cpu);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001527
Gautham R Shenoye08f5f52006-10-26 16:20:58 +05301528 if (ret_freq && policy->cur &&
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02001529 !(cpufreq_driver->flags & CPUFREQ_CONST_LOOPS)) {
Gautham R Shenoye08f5f52006-10-26 16:20:58 +05301530 /* verify no discrepancy between actual and
1531 saved value exists */
1532 if (unlikely(ret_freq != policy->cur)) {
1533 cpufreq_out_of_sync(cpu, policy->cur, ret_freq);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001534 schedule_work(&policy->update);
1535 }
1536 }
1537
Dave Jones4d34a672008-02-07 16:33:49 -05001538 return ret_freq;
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08001539}
Linus Torvalds1da177e2005-04-16 15:20:36 -07001540
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08001541/**
1542 * cpufreq_get - get the current CPU frequency (in kHz)
1543 * @cpu: CPU number
1544 *
1545 * Get the CPU current (static) CPU frequency
1546 */
1547unsigned int cpufreq_get(unsigned int cpu)
1548{
Aaron Plattner999976e2014-03-04 12:42:15 -08001549 struct cpufreq_policy *policy = cpufreq_cpu_get(cpu);
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08001550 unsigned int ret_freq = 0;
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08001551
Aaron Plattner999976e2014-03-04 12:42:15 -08001552 if (policy) {
1553 down_read(&policy->rwsem);
1554 ret_freq = __cpufreq_get(cpu);
1555 up_read(&policy->rwsem);
Viresh Kumar26ca8692013-09-20 22:37:31 +05301556
Aaron Plattner999976e2014-03-04 12:42:15 -08001557 cpufreq_cpu_put(policy);
1558 }
Viresh Kumar6eed9402013-08-06 22:53:11 +05301559
Dave Jones4d34a672008-02-07 16:33:49 -05001560 return ret_freq;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001561}
1562EXPORT_SYMBOL(cpufreq_get);
1563
Kay Sievers8a25a2f2011-12-21 14:29:42 -08001564static struct subsys_interface cpufreq_interface = {
1565 .name = "cpufreq",
1566 .subsys = &cpu_subsys,
1567 .add_dev = cpufreq_add_dev,
1568 .remove_dev = cpufreq_remove_dev,
Rafael J. Wysockie00e56d2011-03-23 22:16:32 +01001569};
1570
Viresh Kumare28867e2014-03-04 11:00:27 +08001571/*
1572 * In case platform wants some specific frequency to be configured
1573 * during suspend..
Benjamin Herrenschmidt42d4dc32005-04-29 07:40:12 -07001574 */
Viresh Kumare28867e2014-03-04 11:00:27 +08001575int cpufreq_generic_suspend(struct cpufreq_policy *policy)
Benjamin Herrenschmidt42d4dc32005-04-29 07:40:12 -07001576{
Viresh Kumare28867e2014-03-04 11:00:27 +08001577 int ret;
Dave Jones4bc5d342009-08-04 14:03:25 -04001578
Viresh Kumare28867e2014-03-04 11:00:27 +08001579 if (!policy->suspend_freq) {
1580 pr_err("%s: suspend_freq can't be zero\n", __func__);
1581 return -EINVAL;
Benjamin Herrenschmidt42d4dc32005-04-29 07:40:12 -07001582 }
1583
Viresh Kumare28867e2014-03-04 11:00:27 +08001584 pr_debug("%s: Setting suspend-freq: %u\n", __func__,
1585 policy->suspend_freq);
1586
1587 ret = __cpufreq_driver_target(policy, policy->suspend_freq,
1588 CPUFREQ_RELATION_H);
1589 if (ret)
1590 pr_err("%s: unable to set suspend-freq: %u. err: %d\n",
1591 __func__, policy->suspend_freq, ret);
1592
Dave Jonesc9060492008-02-07 16:32:18 -05001593 return ret;
Benjamin Herrenschmidt42d4dc32005-04-29 07:40:12 -07001594}
Viresh Kumare28867e2014-03-04 11:00:27 +08001595EXPORT_SYMBOL(cpufreq_generic_suspend);
Benjamin Herrenschmidt42d4dc32005-04-29 07:40:12 -07001596
1597/**
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001598 * cpufreq_suspend() - Suspend CPUFreq governors
Linus Torvalds1da177e2005-04-16 15:20:36 -07001599 *
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001600 * Called during system wide Suspend/Hibernate cycles for suspending governors
1601 * as some platforms can't change frequency after this point in suspend cycle.
1602 * Because some of the devices (like: i2c, regulators, etc) they use for
1603 * changing frequency are suspended quickly after this point.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001604 */
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001605void cpufreq_suspend(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001606{
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301607 struct cpufreq_policy *policy;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001608
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001609 if (!cpufreq_driver)
Rafael J. Wysockie00e56d2011-03-23 22:16:32 +01001610 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001611
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001612 if (!has_target())
1613 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001614
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001615 pr_debug("%s: Suspending Governors\n", __func__);
1616
1617 list_for_each_entry(policy, &cpufreq_policy_list, policy_list) {
1618 if (__cpufreq_governor(policy, CPUFREQ_GOV_STOP))
1619 pr_err("%s: Failed to stop governor for policy: %p\n",
1620 __func__, policy);
1621 else if (cpufreq_driver->suspend
1622 && cpufreq_driver->suspend(policy))
1623 pr_err("%s: Failed to suspend driver: %p\n", __func__,
1624 policy);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001625 }
1626
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001627 cpufreq_suspended = true;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001628}
1629
Linus Torvalds1da177e2005-04-16 15:20:36 -07001630/**
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001631 * cpufreq_resume() - Resume CPUFreq governors
Linus Torvalds1da177e2005-04-16 15:20:36 -07001632 *
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001633 * Called during system wide Suspend/Hibernate cycle for resuming governors that
1634 * are suspended with cpufreq_suspend().
Linus Torvalds1da177e2005-04-16 15:20:36 -07001635 */
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001636void cpufreq_resume(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001637{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001638 struct cpufreq_policy *policy;
1639
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001640 if (!cpufreq_driver)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001641 return;
1642
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001643 if (!has_target())
1644 return;
1645
1646 pr_debug("%s: Resuming Governors\n", __func__);
1647
1648 cpufreq_suspended = false;
1649
1650 list_for_each_entry(policy, &cpufreq_policy_list, policy_list) {
1651 if (__cpufreq_governor(policy, CPUFREQ_GOV_START)
1652 || __cpufreq_governor(policy, CPUFREQ_GOV_LIMITS))
1653 pr_err("%s: Failed to start governor for policy: %p\n",
1654 __func__, policy);
1655 else if (cpufreq_driver->resume
1656 && cpufreq_driver->resume(policy))
1657 pr_err("%s: Failed to resume driver: %p\n", __func__,
1658 policy);
1659
1660 /*
1661 * schedule call cpufreq_update_policy() for boot CPU, i.e. last
1662 * policy in list. It will verify that the current freq is in
1663 * sync with what we believe it to be.
1664 */
1665 if (list_is_last(&policy->policy_list, &cpufreq_policy_list))
1666 schedule_work(&policy->update);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001667 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001668}
Linus Torvalds1da177e2005-04-16 15:20:36 -07001669
Borislav Petkov9d950462013-01-20 10:24:28 +00001670/**
1671 * cpufreq_get_current_driver - return current driver's name
1672 *
1673 * Return the name string of the currently loaded cpufreq driver
1674 * or NULL, if none.
1675 */
1676const char *cpufreq_get_current_driver(void)
1677{
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02001678 if (cpufreq_driver)
1679 return cpufreq_driver->name;
1680
1681 return NULL;
Borislav Petkov9d950462013-01-20 10:24:28 +00001682}
1683EXPORT_SYMBOL_GPL(cpufreq_get_current_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001684
1685/*********************************************************************
1686 * NOTIFIER LISTS INTERFACE *
1687 *********************************************************************/
1688
1689/**
1690 * cpufreq_register_notifier - register a driver with cpufreq
1691 * @nb: notifier function to register
1692 * @list: CPUFREQ_TRANSITION_NOTIFIER or CPUFREQ_POLICY_NOTIFIER
1693 *
Dave Jones32ee8c32006-02-28 00:43:23 -05001694 * Add a driver to one of two lists: either a list of drivers that
Linus Torvalds1da177e2005-04-16 15:20:36 -07001695 * are notified about clock rate changes (once before and once after
1696 * the transition), or a list of drivers that are notified about
1697 * changes in cpufreq policy.
1698 *
1699 * This function may sleep, and has the same return conditions as
Alan Sterne041c682006-03-27 01:16:30 -08001700 * blocking_notifier_chain_register.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001701 */
1702int cpufreq_register_notifier(struct notifier_block *nb, unsigned int list)
1703{
1704 int ret;
1705
Dirk Brandewied5aaffa2013-01-17 16:22:21 +00001706 if (cpufreq_disabled())
1707 return -EINVAL;
1708
Cesar Eduardo Barros74212ca2008-02-16 08:41:24 -02001709 WARN_ON(!init_cpufreq_transition_notifier_list_called);
1710
Linus Torvalds1da177e2005-04-16 15:20:36 -07001711 switch (list) {
1712 case CPUFREQ_TRANSITION_NOTIFIER:
Alan Sternb4dfdbb2006-10-04 02:17:06 -07001713 ret = srcu_notifier_chain_register(
Alan Sterne041c682006-03-27 01:16:30 -08001714 &cpufreq_transition_notifier_list, nb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001715 break;
1716 case CPUFREQ_POLICY_NOTIFIER:
Alan Sterne041c682006-03-27 01:16:30 -08001717 ret = blocking_notifier_chain_register(
1718 &cpufreq_policy_notifier_list, nb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001719 break;
1720 default:
1721 ret = -EINVAL;
1722 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001723
1724 return ret;
1725}
1726EXPORT_SYMBOL(cpufreq_register_notifier);
1727
Linus Torvalds1da177e2005-04-16 15:20:36 -07001728/**
1729 * cpufreq_unregister_notifier - unregister a driver with cpufreq
1730 * @nb: notifier block to be unregistered
Viresh Kumarbb176f72013-06-19 14:19:33 +05301731 * @list: CPUFREQ_TRANSITION_NOTIFIER or CPUFREQ_POLICY_NOTIFIER
Linus Torvalds1da177e2005-04-16 15:20:36 -07001732 *
1733 * Remove a driver from the CPU frequency notifier list.
1734 *
1735 * This function may sleep, and has the same return conditions as
Alan Sterne041c682006-03-27 01:16:30 -08001736 * blocking_notifier_chain_unregister.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001737 */
1738int cpufreq_unregister_notifier(struct notifier_block *nb, unsigned int list)
1739{
1740 int ret;
1741
Dirk Brandewied5aaffa2013-01-17 16:22:21 +00001742 if (cpufreq_disabled())
1743 return -EINVAL;
1744
Linus Torvalds1da177e2005-04-16 15:20:36 -07001745 switch (list) {
1746 case CPUFREQ_TRANSITION_NOTIFIER:
Alan Sternb4dfdbb2006-10-04 02:17:06 -07001747 ret = srcu_notifier_chain_unregister(
Alan Sterne041c682006-03-27 01:16:30 -08001748 &cpufreq_transition_notifier_list, nb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001749 break;
1750 case CPUFREQ_POLICY_NOTIFIER:
Alan Sterne041c682006-03-27 01:16:30 -08001751 ret = blocking_notifier_chain_unregister(
1752 &cpufreq_policy_notifier_list, nb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001753 break;
1754 default:
1755 ret = -EINVAL;
1756 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001757
1758 return ret;
1759}
1760EXPORT_SYMBOL(cpufreq_unregister_notifier);
1761
1762
1763/*********************************************************************
1764 * GOVERNORS *
1765 *********************************************************************/
1766
Linus Torvalds1da177e2005-04-16 15:20:36 -07001767int __cpufreq_driver_target(struct cpufreq_policy *policy,
1768 unsigned int target_freq,
1769 unsigned int relation)
1770{
1771 int retval = -EINVAL;
Viresh Kumar72499242012-10-31 01:28:21 +01001772 unsigned int old_target_freq = target_freq;
Ashok Rajc32b6b82005-10-30 14:59:54 -08001773
Konrad Rzeszutek Wilka7b422c2012-03-13 19:18:39 -04001774 if (cpufreq_disabled())
1775 return -ENODEV;
1776
Viresh Kumar72499242012-10-31 01:28:21 +01001777 /* Make sure that target_freq is within supported range */
1778 if (target_freq > policy->max)
1779 target_freq = policy->max;
1780 if (target_freq < policy->min)
1781 target_freq = policy->min;
1782
1783 pr_debug("target for CPU %u: %u kHz, relation %u, requested %u kHz\n",
Joe Perchese837f9b2014-03-11 10:03:00 -07001784 policy->cpu, target_freq, relation, old_target_freq);
Viresh Kumar5a1c0222012-10-31 01:28:15 +01001785
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +05301786 /*
1787 * This might look like a redundant call as we are checking it again
1788 * after finding index. But it is left intentionally for cases where
1789 * exactly same freq is called again and so we can save on few function
1790 * calls.
1791 */
Viresh Kumar5a1c0222012-10-31 01:28:15 +01001792 if (target_freq == policy->cur)
1793 return 0;
1794
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02001795 if (cpufreq_driver->target)
1796 retval = cpufreq_driver->target(policy, target_freq, relation);
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +05301797 else if (cpufreq_driver->target_index) {
1798 struct cpufreq_frequency_table *freq_table;
Viresh Kumard4019f02013-08-14 19:38:24 +05301799 struct cpufreq_freqs freqs;
1800 bool notify;
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +05301801 int index;
Ashok Raj90d45d12005-11-08 21:34:24 -08001802
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +05301803 freq_table = cpufreq_frequency_get_table(policy->cpu);
1804 if (unlikely(!freq_table)) {
1805 pr_err("%s: Unable to find freq_table\n", __func__);
1806 goto out;
1807 }
1808
1809 retval = cpufreq_frequency_table_target(policy, freq_table,
1810 target_freq, relation, &index);
1811 if (unlikely(retval)) {
1812 pr_err("%s: Unable to find matching freq\n", __func__);
1813 goto out;
1814 }
1815
Viresh Kumard4019f02013-08-14 19:38:24 +05301816 if (freq_table[index].frequency == policy->cur) {
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +05301817 retval = 0;
Viresh Kumard4019f02013-08-14 19:38:24 +05301818 goto out;
1819 }
1820
1821 notify = !(cpufreq_driver->flags & CPUFREQ_ASYNC_NOTIFICATION);
1822
1823 if (notify) {
1824 freqs.old = policy->cur;
1825 freqs.new = freq_table[index].frequency;
1826 freqs.flags = 0;
1827
1828 pr_debug("%s: cpu: %d, oldfreq: %u, new freq: %u\n",
Joe Perchese837f9b2014-03-11 10:03:00 -07001829 __func__, policy->cpu, freqs.old, freqs.new);
Viresh Kumard4019f02013-08-14 19:38:24 +05301830
1831 cpufreq_notify_transition(policy, &freqs,
1832 CPUFREQ_PRECHANGE);
1833 }
1834
1835 retval = cpufreq_driver->target_index(policy, index);
1836 if (retval)
1837 pr_err("%s: Failed to change cpu frequency: %d\n",
Joe Perchese837f9b2014-03-11 10:03:00 -07001838 __func__, retval);
Viresh Kumard4019f02013-08-14 19:38:24 +05301839
Viresh Kumarab1b1c42013-12-02 11:04:13 +05301840 if (notify)
1841 cpufreq_notify_post_transition(policy, &freqs, retval);
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +05301842 }
1843
1844out:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001845 return retval;
1846}
1847EXPORT_SYMBOL_GPL(__cpufreq_driver_target);
1848
Linus Torvalds1da177e2005-04-16 15:20:36 -07001849int cpufreq_driver_target(struct cpufreq_policy *policy,
1850 unsigned int target_freq,
1851 unsigned int relation)
1852{
Julia Lawallf1829e42008-07-25 22:44:53 +02001853 int ret = -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001854
viresh kumarad7722d2013-10-18 19:10:15 +05301855 down_write(&policy->rwsem);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001856
1857 ret = __cpufreq_driver_target(policy, target_freq, relation);
1858
viresh kumarad7722d2013-10-18 19:10:15 +05301859 up_write(&policy->rwsem);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001860
Linus Torvalds1da177e2005-04-16 15:20:36 -07001861 return ret;
1862}
1863EXPORT_SYMBOL_GPL(cpufreq_driver_target);
1864
Arjan van de Ven153d7f32006-07-26 15:40:07 +02001865/*
Arjan van de Ven153d7f32006-07-26 15:40:07 +02001866 * when "event" is CPUFREQ_GOV_LIMITS
1867 */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001868
Gautham R Shenoye08f5f52006-10-26 16:20:58 +05301869static int __cpufreq_governor(struct cpufreq_policy *policy,
1870 unsigned int event)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001871{
Dave Jonescc993ca2005-07-28 09:43:56 -07001872 int ret;
Thomas Renninger6afde102007-10-02 13:28:13 -07001873
1874 /* Only must be defined when default governor is known to have latency
1875 restrictions, like e.g. conservative or ondemand.
1876 That this is the case is already ensured in Kconfig
1877 */
1878#ifdef CONFIG_CPU_FREQ_GOV_PERFORMANCE
1879 struct cpufreq_governor *gov = &cpufreq_gov_performance;
1880#else
1881 struct cpufreq_governor *gov = NULL;
1882#endif
Thomas Renninger1c256242007-10-02 13:28:12 -07001883
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001884 /* Don't start any governor operations if we are entering suspend */
1885 if (cpufreq_suspended)
1886 return 0;
1887
Thomas Renninger1c256242007-10-02 13:28:12 -07001888 if (policy->governor->max_transition_latency &&
1889 policy->cpuinfo.transition_latency >
1890 policy->governor->max_transition_latency) {
Thomas Renninger6afde102007-10-02 13:28:13 -07001891 if (!gov)
1892 return -EINVAL;
1893 else {
Joe Perchese837f9b2014-03-11 10:03:00 -07001894 pr_warn("%s governor failed, too long transition latency of HW, fallback to %s governor\n",
1895 policy->governor->name, gov->name);
Thomas Renninger6afde102007-10-02 13:28:13 -07001896 policy->governor = gov;
1897 }
Thomas Renninger1c256242007-10-02 13:28:12 -07001898 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001899
Viresh Kumarfe492f32013-08-06 22:53:10 +05301900 if (event == CPUFREQ_GOV_POLICY_INIT)
1901 if (!try_module_get(policy->governor->owner))
1902 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001903
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02001904 pr_debug("__cpufreq_governor for CPU %u, event %u\n",
Joe Perchese837f9b2014-03-11 10:03:00 -07001905 policy->cpu, event);
Xiaoguang Chen95731eb2013-06-19 15:00:07 +08001906
1907 mutex_lock(&cpufreq_governor_lock);
Srivatsa S. Bhat56d07db2013-09-07 01:23:55 +05301908 if ((policy->governor_enabled && event == CPUFREQ_GOV_START)
Viresh Kumarf73d3932013-08-31 17:53:40 +05301909 || (!policy->governor_enabled
1910 && (event == CPUFREQ_GOV_LIMITS || event == CPUFREQ_GOV_STOP))) {
Xiaoguang Chen95731eb2013-06-19 15:00:07 +08001911 mutex_unlock(&cpufreq_governor_lock);
1912 return -EBUSY;
1913 }
1914
1915 if (event == CPUFREQ_GOV_STOP)
1916 policy->governor_enabled = false;
1917 else if (event == CPUFREQ_GOV_START)
1918 policy->governor_enabled = true;
1919
1920 mutex_unlock(&cpufreq_governor_lock);
1921
Linus Torvalds1da177e2005-04-16 15:20:36 -07001922 ret = policy->governor->governor(policy, event);
1923
Viresh Kumar4d5dcc42013-03-27 15:58:58 +00001924 if (!ret) {
1925 if (event == CPUFREQ_GOV_POLICY_INIT)
1926 policy->governor->initialized++;
1927 else if (event == CPUFREQ_GOV_POLICY_EXIT)
1928 policy->governor->initialized--;
Xiaoguang Chen95731eb2013-06-19 15:00:07 +08001929 } else {
1930 /* Restore original values */
1931 mutex_lock(&cpufreq_governor_lock);
1932 if (event == CPUFREQ_GOV_STOP)
1933 policy->governor_enabled = true;
1934 else if (event == CPUFREQ_GOV_START)
1935 policy->governor_enabled = false;
1936 mutex_unlock(&cpufreq_governor_lock);
Viresh Kumar4d5dcc42013-03-27 15:58:58 +00001937 }
Viresh Kumarb3940582013-02-01 05:42:58 +00001938
Viresh Kumarfe492f32013-08-06 22:53:10 +05301939 if (((event == CPUFREQ_GOV_POLICY_INIT) && ret) ||
1940 ((event == CPUFREQ_GOV_POLICY_EXIT) && !ret))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001941 module_put(policy->governor->owner);
1942
1943 return ret;
1944}
1945
Linus Torvalds1da177e2005-04-16 15:20:36 -07001946int cpufreq_register_governor(struct cpufreq_governor *governor)
1947{
Jeremy Fitzhardinge3bcb09a2006-07-06 12:30:26 -07001948 int err;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001949
1950 if (!governor)
1951 return -EINVAL;
1952
Konrad Rzeszutek Wilka7b422c2012-03-13 19:18:39 -04001953 if (cpufreq_disabled())
1954 return -ENODEV;
1955
akpm@osdl.org3fc54d32006-01-13 15:54:22 -08001956 mutex_lock(&cpufreq_governor_mutex);
Dave Jones32ee8c32006-02-28 00:43:23 -05001957
Viresh Kumarb3940582013-02-01 05:42:58 +00001958 governor->initialized = 0;
Jeremy Fitzhardinge3bcb09a2006-07-06 12:30:26 -07001959 err = -EBUSY;
1960 if (__find_governor(governor->name) == NULL) {
1961 err = 0;
1962 list_add(&governor->governor_list, &cpufreq_governor_list);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001963 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001964
Dave Jones32ee8c32006-02-28 00:43:23 -05001965 mutex_unlock(&cpufreq_governor_mutex);
Jeremy Fitzhardinge3bcb09a2006-07-06 12:30:26 -07001966 return err;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001967}
1968EXPORT_SYMBOL_GPL(cpufreq_register_governor);
1969
Linus Torvalds1da177e2005-04-16 15:20:36 -07001970void cpufreq_unregister_governor(struct cpufreq_governor *governor)
1971{
Prarit Bhargava90e41ba2009-11-12 09:18:46 -05001972 int cpu;
Prarit Bhargava90e41ba2009-11-12 09:18:46 -05001973
Linus Torvalds1da177e2005-04-16 15:20:36 -07001974 if (!governor)
1975 return;
1976
Konrad Rzeszutek Wilka7b422c2012-03-13 19:18:39 -04001977 if (cpufreq_disabled())
1978 return;
1979
Prarit Bhargava90e41ba2009-11-12 09:18:46 -05001980 for_each_present_cpu(cpu) {
1981 if (cpu_online(cpu))
1982 continue;
1983 if (!strcmp(per_cpu(cpufreq_cpu_governor, cpu), governor->name))
1984 strcpy(per_cpu(cpufreq_cpu_governor, cpu), "\0");
1985 }
Prarit Bhargava90e41ba2009-11-12 09:18:46 -05001986
akpm@osdl.org3fc54d32006-01-13 15:54:22 -08001987 mutex_lock(&cpufreq_governor_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001988 list_del(&governor->governor_list);
akpm@osdl.org3fc54d32006-01-13 15:54:22 -08001989 mutex_unlock(&cpufreq_governor_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001990 return;
1991}
1992EXPORT_SYMBOL_GPL(cpufreq_unregister_governor);
1993
1994
Linus Torvalds1da177e2005-04-16 15:20:36 -07001995/*********************************************************************
1996 * POLICY INTERFACE *
1997 *********************************************************************/
1998
1999/**
2000 * cpufreq_get_policy - get the current cpufreq_policy
Dave Jones29464f22009-01-18 01:37:11 -05002001 * @policy: struct cpufreq_policy into which the current cpufreq_policy
2002 * is written
Linus Torvalds1da177e2005-04-16 15:20:36 -07002003 *
2004 * Reads the current cpufreq policy.
2005 */
2006int cpufreq_get_policy(struct cpufreq_policy *policy, unsigned int cpu)
2007{
2008 struct cpufreq_policy *cpu_policy;
2009 if (!policy)
2010 return -EINVAL;
2011
2012 cpu_policy = cpufreq_cpu_get(cpu);
2013 if (!cpu_policy)
2014 return -EINVAL;
2015
Viresh Kumard5b73cd2013-08-06 22:53:06 +05302016 memcpy(policy, cpu_policy, sizeof(*policy));
Linus Torvalds1da177e2005-04-16 15:20:36 -07002017
2018 cpufreq_cpu_put(cpu_policy);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002019 return 0;
2020}
2021EXPORT_SYMBOL(cpufreq_get_policy);
2022
Arjan van de Ven153d7f32006-07-26 15:40:07 +02002023/*
Viresh Kumar037ce832013-10-02 14:13:16 +05302024 * policy : current policy.
2025 * new_policy: policy to be set.
Arjan van de Ven153d7f32006-07-26 15:40:07 +02002026 */
Viresh Kumar037ce832013-10-02 14:13:16 +05302027static int cpufreq_set_policy(struct cpufreq_policy *policy,
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302028 struct cpufreq_policy *new_policy)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002029{
Rafael J. Wysockid9a789c2014-02-17 22:56:35 +01002030 struct cpufreq_governor *old_gov;
2031 int ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002032
Joe Perchese837f9b2014-03-11 10:03:00 -07002033 pr_debug("setting new policy for CPU %u: %u - %u kHz\n",
2034 new_policy->cpu, new_policy->min, new_policy->max);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002035
Viresh Kumard5b73cd2013-08-06 22:53:06 +05302036 memcpy(&new_policy->cpuinfo, &policy->cpuinfo, sizeof(policy->cpuinfo));
Linus Torvalds1da177e2005-04-16 15:20:36 -07002037
Rafael J. Wysockid9a789c2014-02-17 22:56:35 +01002038 if (new_policy->min > policy->max || new_policy->max < policy->min)
2039 return -EINVAL;
Mattia Dongili9c9a43e2006-07-05 23:12:20 +02002040
Linus Torvalds1da177e2005-04-16 15:20:36 -07002041 /* verify the cpu speed can be set within this limit */
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302042 ret = cpufreq_driver->verify(new_policy);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002043 if (ret)
Rafael J. Wysockid9a789c2014-02-17 22:56:35 +01002044 return ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002045
Linus Torvalds1da177e2005-04-16 15:20:36 -07002046 /* adjust if necessary - all reasons */
Alan Sterne041c682006-03-27 01:16:30 -08002047 blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302048 CPUFREQ_ADJUST, new_policy);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002049
2050 /* adjust if necessary - hardware incompatibility*/
Alan Sterne041c682006-03-27 01:16:30 -08002051 blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302052 CPUFREQ_INCOMPATIBLE, new_policy);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002053
Viresh Kumarbb176f72013-06-19 14:19:33 +05302054 /*
2055 * verify the cpu speed can be set within this limit, which might be
2056 * different to the first one
2057 */
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302058 ret = cpufreq_driver->verify(new_policy);
Alan Sterne041c682006-03-27 01:16:30 -08002059 if (ret)
Rafael J. Wysockid9a789c2014-02-17 22:56:35 +01002060 return ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002061
2062 /* notification of the new policy */
Alan Sterne041c682006-03-27 01:16:30 -08002063 blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302064 CPUFREQ_NOTIFY, new_policy);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002065
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302066 policy->min = new_policy->min;
2067 policy->max = new_policy->max;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002068
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02002069 pr_debug("new min and max freqs are %u - %u kHz\n",
Joe Perchese837f9b2014-03-11 10:03:00 -07002070 policy->min, policy->max);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002071
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02002072 if (cpufreq_driver->setpolicy) {
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302073 policy->policy = new_policy->policy;
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02002074 pr_debug("setting range\n");
Rafael J. Wysockid9a789c2014-02-17 22:56:35 +01002075 return cpufreq_driver->setpolicy(new_policy);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002076 }
2077
Rafael J. Wysockid9a789c2014-02-17 22:56:35 +01002078 if (new_policy->governor == policy->governor)
2079 goto out;
2080
2081 pr_debug("governor switch\n");
2082
2083 /* save old, working values */
2084 old_gov = policy->governor;
2085 /* end old governor */
2086 if (old_gov) {
2087 __cpufreq_governor(policy, CPUFREQ_GOV_STOP);
2088 up_write(&policy->rwsem);
2089 __cpufreq_governor(policy,CPUFREQ_GOV_POLICY_EXIT);
2090 down_write(&policy->rwsem);
2091 }
2092
2093 /* start new governor */
2094 policy->governor = new_policy->governor;
2095 if (!__cpufreq_governor(policy, CPUFREQ_GOV_POLICY_INIT)) {
2096 if (!__cpufreq_governor(policy, CPUFREQ_GOV_START))
2097 goto out;
2098
2099 up_write(&policy->rwsem);
2100 __cpufreq_governor(policy, CPUFREQ_GOV_POLICY_EXIT);
2101 down_write(&policy->rwsem);
2102 }
2103
2104 /* new governor failed, so re-start old one */
2105 pr_debug("starting governor %s failed\n", policy->governor->name);
2106 if (old_gov) {
2107 policy->governor = old_gov;
2108 __cpufreq_governor(policy, CPUFREQ_GOV_POLICY_INIT);
2109 __cpufreq_governor(policy, CPUFREQ_GOV_START);
2110 }
2111
2112 return -EINVAL;
2113
2114 out:
2115 pr_debug("governor: change or update limits\n");
2116 return __cpufreq_governor(policy, CPUFREQ_GOV_LIMITS);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002117}
2118
2119/**
Linus Torvalds1da177e2005-04-16 15:20:36 -07002120 * cpufreq_update_policy - re-evaluate an existing cpufreq policy
2121 * @cpu: CPU which shall be re-evaluated
2122 *
Lucas De Marchi25985ed2011-03-30 22:57:33 -03002123 * Useful for policy notifiers which have different necessities
Linus Torvalds1da177e2005-04-16 15:20:36 -07002124 * at different times.
2125 */
2126int cpufreq_update_policy(unsigned int cpu)
2127{
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302128 struct cpufreq_policy *policy = cpufreq_cpu_get(cpu);
2129 struct cpufreq_policy new_policy;
Julia Lawallf1829e42008-07-25 22:44:53 +02002130 int ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002131
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302132 if (!policy) {
Julia Lawallf1829e42008-07-25 22:44:53 +02002133 ret = -ENODEV;
2134 goto no_policy;
2135 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002136
viresh kumarad7722d2013-10-18 19:10:15 +05302137 down_write(&policy->rwsem);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002138
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02002139 pr_debug("updating policy for CPU %u\n", cpu);
Viresh Kumard5b73cd2013-08-06 22:53:06 +05302140 memcpy(&new_policy, policy, sizeof(*policy));
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302141 new_policy.min = policy->user_policy.min;
2142 new_policy.max = policy->user_policy.max;
2143 new_policy.policy = policy->user_policy.policy;
2144 new_policy.governor = policy->user_policy.governor;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002145
Viresh Kumarbb176f72013-06-19 14:19:33 +05302146 /*
2147 * BIOS might change freq behind our back
2148 * -> ask driver for current freq and notify governors about a change
2149 */
Rafael J. Wysocki2ed99e32014-03-12 21:49:33 +01002150 if (cpufreq_driver->get && !cpufreq_driver->setpolicy) {
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302151 new_policy.cur = cpufreq_driver->get(cpu);
Viresh Kumarbd0fa9b2014-02-25 14:29:44 +05302152 if (WARN_ON(!new_policy.cur)) {
2153 ret = -EIO;
2154 goto no_policy;
2155 }
2156
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302157 if (!policy->cur) {
Joe Perchese837f9b2014-03-11 10:03:00 -07002158 pr_debug("Driver did not initialize current freq\n");
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302159 policy->cur = new_policy.cur;
Thomas Renningera85f7bd2006-02-01 11:36:04 +01002160 } else {
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +05302161 if (policy->cur != new_policy.cur && has_target())
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302162 cpufreq_out_of_sync(cpu, policy->cur,
2163 new_policy.cur);
Thomas Renningera85f7bd2006-02-01 11:36:04 +01002164 }
Thomas Renninger0961dd02006-01-26 18:46:33 +01002165 }
2166
Viresh Kumar037ce832013-10-02 14:13:16 +05302167 ret = cpufreq_set_policy(policy, &new_policy);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002168
viresh kumarad7722d2013-10-18 19:10:15 +05302169 up_write(&policy->rwsem);
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08002170
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302171 cpufreq_cpu_put(policy);
Julia Lawallf1829e42008-07-25 22:44:53 +02002172no_policy:
Linus Torvalds1da177e2005-04-16 15:20:36 -07002173 return ret;
2174}
2175EXPORT_SYMBOL(cpufreq_update_policy);
2176
Paul Gortmaker27609842013-06-19 13:54:04 -04002177static int cpufreq_cpu_callback(struct notifier_block *nfb,
Ashok Rajc32b6b82005-10-30 14:59:54 -08002178 unsigned long action, void *hcpu)
2179{
2180 unsigned int cpu = (unsigned long)hcpu;
Kay Sievers8a25a2f2011-12-21 14:29:42 -08002181 struct device *dev;
Ashok Rajc32b6b82005-10-30 14:59:54 -08002182
Kay Sievers8a25a2f2011-12-21 14:29:42 -08002183 dev = get_cpu_device(cpu);
2184 if (dev) {
Srivatsa S. Bhat5302c3f2013-07-30 04:25:25 +05302185 switch (action & ~CPU_TASKS_FROZEN) {
Ashok Rajc32b6b82005-10-30 14:59:54 -08002186 case CPU_ONLINE:
Viresh Kumar96bbbe42014-03-10 14:53:35 +05302187 __cpufreq_add_dev(dev, NULL);
Ashok Rajc32b6b82005-10-30 14:59:54 -08002188 break;
Srivatsa S. Bhat5302c3f2013-07-30 04:25:25 +05302189
Ashok Rajc32b6b82005-10-30 14:59:54 -08002190 case CPU_DOWN_PREPARE:
Viresh Kumar96bbbe42014-03-10 14:53:35 +05302191 __cpufreq_remove_dev_prepare(dev, NULL);
Srivatsa S. Bhat1aee40a2013-09-07 01:23:27 +05302192 break;
2193
2194 case CPU_POST_DEAD:
Viresh Kumar96bbbe42014-03-10 14:53:35 +05302195 __cpufreq_remove_dev_finish(dev, NULL);
Ashok Rajc32b6b82005-10-30 14:59:54 -08002196 break;
Srivatsa S. Bhat5302c3f2013-07-30 04:25:25 +05302197
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08002198 case CPU_DOWN_FAILED:
Viresh Kumar96bbbe42014-03-10 14:53:35 +05302199 __cpufreq_add_dev(dev, NULL);
Ashok Rajc32b6b82005-10-30 14:59:54 -08002200 break;
2201 }
2202 }
2203 return NOTIFY_OK;
2204}
2205
Neal Buckendahl9c36f742010-06-22 22:02:44 -05002206static struct notifier_block __refdata cpufreq_cpu_notifier = {
Viresh Kumarbb176f72013-06-19 14:19:33 +05302207 .notifier_call = cpufreq_cpu_callback,
Ashok Rajc32b6b82005-10-30 14:59:54 -08002208};
Linus Torvalds1da177e2005-04-16 15:20:36 -07002209
2210/*********************************************************************
Lukasz Majewski6f19efc2013-12-20 15:24:49 +01002211 * BOOST *
2212 *********************************************************************/
2213static int cpufreq_boost_set_sw(int state)
2214{
2215 struct cpufreq_frequency_table *freq_table;
2216 struct cpufreq_policy *policy;
2217 int ret = -EINVAL;
2218
2219 list_for_each_entry(policy, &cpufreq_policy_list, policy_list) {
2220 freq_table = cpufreq_frequency_get_table(policy->cpu);
2221 if (freq_table) {
2222 ret = cpufreq_frequency_table_cpuinfo(policy,
2223 freq_table);
2224 if (ret) {
2225 pr_err("%s: Policy frequency update failed\n",
2226 __func__);
2227 break;
2228 }
2229 policy->user_policy.max = policy->max;
2230 __cpufreq_governor(policy, CPUFREQ_GOV_LIMITS);
2231 }
2232 }
2233
2234 return ret;
2235}
2236
2237int cpufreq_boost_trigger_state(int state)
2238{
2239 unsigned long flags;
2240 int ret = 0;
2241
2242 if (cpufreq_driver->boost_enabled == state)
2243 return 0;
2244
2245 write_lock_irqsave(&cpufreq_driver_lock, flags);
2246 cpufreq_driver->boost_enabled = state;
2247 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
2248
2249 ret = cpufreq_driver->set_boost(state);
2250 if (ret) {
2251 write_lock_irqsave(&cpufreq_driver_lock, flags);
2252 cpufreq_driver->boost_enabled = !state;
2253 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
2254
Joe Perchese837f9b2014-03-11 10:03:00 -07002255 pr_err("%s: Cannot %s BOOST\n",
2256 __func__, state ? "enable" : "disable");
Lukasz Majewski6f19efc2013-12-20 15:24:49 +01002257 }
2258
2259 return ret;
2260}
2261
2262int cpufreq_boost_supported(void)
2263{
2264 if (likely(cpufreq_driver))
2265 return cpufreq_driver->boost_supported;
2266
2267 return 0;
2268}
2269EXPORT_SYMBOL_GPL(cpufreq_boost_supported);
2270
2271int cpufreq_boost_enabled(void)
2272{
2273 return cpufreq_driver->boost_enabled;
2274}
2275EXPORT_SYMBOL_GPL(cpufreq_boost_enabled);
2276
2277/*********************************************************************
Linus Torvalds1da177e2005-04-16 15:20:36 -07002278 * REGISTER / UNREGISTER CPUFREQ DRIVER *
2279 *********************************************************************/
2280
2281/**
2282 * cpufreq_register_driver - register a CPU Frequency driver
2283 * @driver_data: A struct cpufreq_driver containing the values#
2284 * submitted by the CPU Frequency driver.
2285 *
Viresh Kumarbb176f72013-06-19 14:19:33 +05302286 * Registers a CPU Frequency driver to this core code. This code
Linus Torvalds1da177e2005-04-16 15:20:36 -07002287 * returns zero on success, -EBUSY when another driver got here first
Dave Jones32ee8c32006-02-28 00:43:23 -05002288 * (and isn't unregistered in the meantime).
Linus Torvalds1da177e2005-04-16 15:20:36 -07002289 *
2290 */
Linus Torvalds221dee22007-02-26 14:55:48 -08002291int cpufreq_register_driver(struct cpufreq_driver *driver_data)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002292{
2293 unsigned long flags;
2294 int ret;
2295
Konrad Rzeszutek Wilka7b422c2012-03-13 19:18:39 -04002296 if (cpufreq_disabled())
2297 return -ENODEV;
2298
Linus Torvalds1da177e2005-04-16 15:20:36 -07002299 if (!driver_data || !driver_data->verify || !driver_data->init ||
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +05302300 !(driver_data->setpolicy || driver_data->target_index ||
Rafael J. Wysocki98322352014-03-19 12:48:30 +01002301 driver_data->target) ||
2302 (driver_data->setpolicy && (driver_data->target_index ||
2303 driver_data->target)))
Linus Torvalds1da177e2005-04-16 15:20:36 -07002304 return -EINVAL;
2305
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02002306 pr_debug("trying to register driver %s\n", driver_data->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002307
2308 if (driver_data->setpolicy)
2309 driver_data->flags |= CPUFREQ_CONST_LOOPS;
2310
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00002311 write_lock_irqsave(&cpufreq_driver_lock, flags);
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02002312 if (cpufreq_driver) {
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00002313 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
Yinghai Lu4dea58062013-09-18 21:05:20 -07002314 return -EEXIST;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002315 }
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02002316 cpufreq_driver = driver_data;
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00002317 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002318
Lukasz Majewski6f19efc2013-12-20 15:24:49 +01002319 if (cpufreq_boost_supported()) {
2320 /*
2321 * Check if driver provides function to enable boost -
2322 * if not, use cpufreq_boost_set_sw as default
2323 */
2324 if (!cpufreq_driver->set_boost)
2325 cpufreq_driver->set_boost = cpufreq_boost_set_sw;
2326
2327 ret = cpufreq_sysfs_create_file(&boost.attr);
2328 if (ret) {
2329 pr_err("%s: cannot register global BOOST sysfs file\n",
Joe Perchese837f9b2014-03-11 10:03:00 -07002330 __func__);
Lukasz Majewski6f19efc2013-12-20 15:24:49 +01002331 goto err_null_driver;
2332 }
2333 }
2334
Kay Sievers8a25a2f2011-12-21 14:29:42 -08002335 ret = subsys_interface_register(&cpufreq_interface);
Jiri Slaby8f5bc2a2011-03-01 17:41:10 +01002336 if (ret)
Lukasz Majewski6f19efc2013-12-20 15:24:49 +01002337 goto err_boost_unreg;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002338
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02002339 if (!(cpufreq_driver->flags & CPUFREQ_STICKY)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002340 int i;
2341 ret = -ENODEV;
2342
2343 /* check for at least one working CPU */
Mike Travis7a6aedf2008-03-25 15:06:53 -07002344 for (i = 0; i < nr_cpu_ids; i++)
2345 if (cpu_possible(i) && per_cpu(cpufreq_cpu_data, i)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002346 ret = 0;
Mike Travis7a6aedf2008-03-25 15:06:53 -07002347 break;
2348 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002349
2350 /* if all ->init() calls failed, unregister */
2351 if (ret) {
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02002352 pr_debug("no CPU initialized for driver %s\n",
Joe Perchese837f9b2014-03-11 10:03:00 -07002353 driver_data->name);
Kay Sievers8a25a2f2011-12-21 14:29:42 -08002354 goto err_if_unreg;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002355 }
2356 }
2357
Jiri Slaby8f5bc2a2011-03-01 17:41:10 +01002358 register_hotcpu_notifier(&cpufreq_cpu_notifier);
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02002359 pr_debug("driver %s up and running\n", driver_data->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002360
Jiri Slaby8f5bc2a2011-03-01 17:41:10 +01002361 return 0;
Kay Sievers8a25a2f2011-12-21 14:29:42 -08002362err_if_unreg:
2363 subsys_interface_unregister(&cpufreq_interface);
Lukasz Majewski6f19efc2013-12-20 15:24:49 +01002364err_boost_unreg:
2365 if (cpufreq_boost_supported())
2366 cpufreq_sysfs_remove_file(&boost.attr);
Jiri Slaby8f5bc2a2011-03-01 17:41:10 +01002367err_null_driver:
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00002368 write_lock_irqsave(&cpufreq_driver_lock, flags);
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02002369 cpufreq_driver = NULL;
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00002370 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
Dave Jones4d34a672008-02-07 16:33:49 -05002371 return ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002372}
2373EXPORT_SYMBOL_GPL(cpufreq_register_driver);
2374
Linus Torvalds1da177e2005-04-16 15:20:36 -07002375/**
2376 * cpufreq_unregister_driver - unregister the current CPUFreq driver
2377 *
Viresh Kumarbb176f72013-06-19 14:19:33 +05302378 * Unregister the current CPUFreq driver. Only call this if you have
Linus Torvalds1da177e2005-04-16 15:20:36 -07002379 * the right to do so, i.e. if you have succeeded in initialising before!
2380 * Returns zero if successful, and -EINVAL if the cpufreq_driver is
2381 * currently not initialised.
2382 */
Linus Torvalds221dee22007-02-26 14:55:48 -08002383int cpufreq_unregister_driver(struct cpufreq_driver *driver)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002384{
2385 unsigned long flags;
2386
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02002387 if (!cpufreq_driver || (driver != cpufreq_driver))
Linus Torvalds1da177e2005-04-16 15:20:36 -07002388 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002389
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02002390 pr_debug("unregistering driver %s\n", driver->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002391
Kay Sievers8a25a2f2011-12-21 14:29:42 -08002392 subsys_interface_unregister(&cpufreq_interface);
Lukasz Majewski6f19efc2013-12-20 15:24:49 +01002393 if (cpufreq_boost_supported())
2394 cpufreq_sysfs_remove_file(&boost.attr);
2395
Chandra Seetharaman65edc682006-06-27 02:54:08 -07002396 unregister_hotcpu_notifier(&cpufreq_cpu_notifier);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002397
Viresh Kumar6eed9402013-08-06 22:53:11 +05302398 down_write(&cpufreq_rwsem);
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00002399 write_lock_irqsave(&cpufreq_driver_lock, flags);
Viresh Kumar6eed9402013-08-06 22:53:11 +05302400
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02002401 cpufreq_driver = NULL;
Viresh Kumar6eed9402013-08-06 22:53:11 +05302402
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00002403 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
Viresh Kumar6eed9402013-08-06 22:53:11 +05302404 up_write(&cpufreq_rwsem);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002405
2406 return 0;
2407}
2408EXPORT_SYMBOL_GPL(cpufreq_unregister_driver);
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08002409
2410static int __init cpufreq_core_init(void)
2411{
Konrad Rzeszutek Wilka7b422c2012-03-13 19:18:39 -04002412 if (cpufreq_disabled())
2413 return -ENODEV;
2414
Viresh Kumar2361be22013-05-17 16:09:09 +05302415 cpufreq_global_kobject = kobject_create();
Thomas Renninger8aa84ad2009-07-24 15:25:05 +02002416 BUG_ON(!cpufreq_global_kobject);
2417
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08002418 return 0;
2419}
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08002420core_initcall(cpufreq_core_init);