blob: 77a99bfea9a9c43955d238b37f696b911068f1ba [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * linux/drivers/cpufreq/cpufreq.c
3 *
4 * Copyright (C) 2001 Russell King
5 * (C) 2002 - 2003 Dominik Brodowski <linux@brodo.de>
Viresh Kumarbb176f72013-06-19 14:19:33 +05306 * (C) 2013 Viresh Kumar <viresh.kumar@linaro.org>
Linus Torvalds1da177e2005-04-16 15:20:36 -07007 *
Ashok Rajc32b6b82005-10-30 14:59:54 -08008 * Oct 2005 - Ashok Raj <ashok.raj@intel.com>
Dave Jones32ee8c32006-02-28 00:43:23 -05009 * Added handling for CPU hotplug
Dave Jones8ff69732006-03-05 03:37:23 -050010 * Feb 2006 - Jacob Shin <jacob.shin@amd.com>
11 * Fix handling for CPU hotplug -- affected CPUs
Ashok Rajc32b6b82005-10-30 14:59:54 -080012 *
Linus Torvalds1da177e2005-04-16 15:20:36 -070013 * This program is free software; you can redistribute it and/or modify
14 * it under the terms of the GNU General Public License version 2 as
15 * published by the Free Software Foundation.
Linus Torvalds1da177e2005-04-16 15:20:36 -070016 */
17
Viresh Kumardb701152012-10-23 01:29:03 +020018#define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
19
Viresh Kumar5ff0a262013-08-06 22:53:03 +053020#include <linux/cpu.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070021#include <linux/cpufreq.h>
22#include <linux/delay.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070023#include <linux/device.h>
Viresh Kumar5ff0a262013-08-06 22:53:03 +053024#include <linux/init.h>
25#include <linux/kernel_stat.h>
26#include <linux/module.h>
akpm@osdl.org3fc54d32006-01-13 15:54:22 -080027#include <linux/mutex.h>
Viresh Kumar5ff0a262013-08-06 22:53:03 +053028#include <linux/slab.h>
Viresh Kumar2f0aea92014-03-04 11:00:26 +080029#include <linux/suspend.h>
Viresh Kumar5ff0a262013-08-06 22:53:03 +053030#include <linux/tick.h>
Thomas Renninger6f4f2722010-04-20 13:17:36 +020031#include <trace/events/power.h>
32
Linus Torvalds1da177e2005-04-16 15:20:36 -070033/**
Dave Jonescd878472006-08-11 17:59:28 -040034 * The "cpufreq driver" - the arch- or hardware-dependent low
Linus Torvalds1da177e2005-04-16 15:20:36 -070035 * level driver of CPUFreq support, and its spinlock. This lock
36 * also protects the cpufreq_cpu_data array.
37 */
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +020038static struct cpufreq_driver *cpufreq_driver;
Mike Travis7a6aedf2008-03-25 15:06:53 -070039static DEFINE_PER_CPU(struct cpufreq_policy *, cpufreq_cpu_data);
Srivatsa S. Bhat84148092013-07-30 04:25:10 +053040static DEFINE_PER_CPU(struct cpufreq_policy *, cpufreq_cpu_data_fallback);
Viresh Kumarbb176f72013-06-19 14:19:33 +053041static DEFINE_RWLOCK(cpufreq_driver_lock);
Jane Li6f1e4ef2014-01-03 17:17:41 +080042DEFINE_MUTEX(cpufreq_governor_lock);
Lukasz Majewskic88a1f82013-08-06 22:53:08 +053043static LIST_HEAD(cpufreq_policy_list);
Viresh Kumarbb176f72013-06-19 14:19:33 +053044
Thomas Renninger084f3492007-07-09 11:35:28 -070045/* This one keeps track of the previously set governor of a removed CPU */
Dmitry Monakhove77b89f2009-10-05 00:38:55 +040046static DEFINE_PER_CPU(char[CPUFREQ_NAME_LEN], cpufreq_cpu_governor);
Linus Torvalds1da177e2005-04-16 15:20:36 -070047
Viresh Kumar2f0aea92014-03-04 11:00:26 +080048/* Flag to suspend/resume CPUFreq governors */
49static bool cpufreq_suspended;
Linus Torvalds1da177e2005-04-16 15:20:36 -070050
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +053051static inline bool has_target(void)
52{
53 return cpufreq_driver->target_index || cpufreq_driver->target;
54}
55
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -080056/*
Viresh Kumar6eed9402013-08-06 22:53:11 +053057 * rwsem to guarantee that cpufreq driver module doesn't unload during critical
58 * sections
59 */
60static DECLARE_RWSEM(cpufreq_rwsem);
61
Linus Torvalds1da177e2005-04-16 15:20:36 -070062/* internal prototypes */
Dave Jones29464f22009-01-18 01:37:11 -050063static int __cpufreq_governor(struct cpufreq_policy *policy,
64 unsigned int event);
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -080065static unsigned int __cpufreq_get(unsigned int cpu);
David Howells65f27f32006-11-22 14:55:48 +000066static void handle_update(struct work_struct *work);
Linus Torvalds1da177e2005-04-16 15:20:36 -070067
68/**
Dave Jones32ee8c32006-02-28 00:43:23 -050069 * Two notifier lists: the "policy" list is involved in the
70 * validation process for a new CPU frequency policy; the
Linus Torvalds1da177e2005-04-16 15:20:36 -070071 * "transition" list for kernel code that needs to handle
72 * changes to devices when the CPU clock speed changes.
73 * The mutex locks both lists.
74 */
Alan Sterne041c682006-03-27 01:16:30 -080075static BLOCKING_NOTIFIER_HEAD(cpufreq_policy_notifier_list);
Alan Sternb4dfdbb2006-10-04 02:17:06 -070076static struct srcu_notifier_head cpufreq_transition_notifier_list;
Linus Torvalds1da177e2005-04-16 15:20:36 -070077
Cesar Eduardo Barros74212ca2008-02-16 08:41:24 -020078static bool init_cpufreq_transition_notifier_list_called;
Alan Sternb4dfdbb2006-10-04 02:17:06 -070079static int __init init_cpufreq_transition_notifier_list(void)
80{
81 srcu_init_notifier_head(&cpufreq_transition_notifier_list);
Cesar Eduardo Barros74212ca2008-02-16 08:41:24 -020082 init_cpufreq_transition_notifier_list_called = true;
Alan Sternb4dfdbb2006-10-04 02:17:06 -070083 return 0;
84}
Linus Torvaldsb3438f82006-11-20 11:47:18 -080085pure_initcall(init_cpufreq_transition_notifier_list);
Linus Torvalds1da177e2005-04-16 15:20:36 -070086
Konrad Rzeszutek Wilka7b422c2012-03-13 19:18:39 -040087static int off __read_mostly;
Viresh Kumarda584452012-10-26 00:51:32 +020088static int cpufreq_disabled(void)
Konrad Rzeszutek Wilka7b422c2012-03-13 19:18:39 -040089{
90 return off;
91}
92void disable_cpufreq(void)
93{
94 off = 1;
95}
Linus Torvalds1da177e2005-04-16 15:20:36 -070096static LIST_HEAD(cpufreq_governor_list);
Dave Jones29464f22009-01-18 01:37:11 -050097static DEFINE_MUTEX(cpufreq_governor_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -070098
Viresh Kumar4d5dcc42013-03-27 15:58:58 +000099bool have_governor_per_policy(void)
100{
Viresh Kumar0b981e72013-10-02 14:13:18 +0530101 return !!(cpufreq_driver->flags & CPUFREQ_HAVE_GOVERNOR_PER_POLICY);
Viresh Kumar4d5dcc42013-03-27 15:58:58 +0000102}
Viresh Kumar3f869d62013-05-16 05:09:56 +0000103EXPORT_SYMBOL_GPL(have_governor_per_policy);
Viresh Kumar4d5dcc42013-03-27 15:58:58 +0000104
Viresh Kumar944e9a02013-05-16 05:09:57 +0000105struct kobject *get_governor_parent_kobj(struct cpufreq_policy *policy)
106{
107 if (have_governor_per_policy())
108 return &policy->kobj;
109 else
110 return cpufreq_global_kobject;
111}
112EXPORT_SYMBOL_GPL(get_governor_parent_kobj);
113
Viresh Kumar72a4ce32013-05-17 11:26:32 +0000114static inline u64 get_cpu_idle_time_jiffy(unsigned int cpu, u64 *wall)
115{
116 u64 idle_time;
117 u64 cur_wall_time;
118 u64 busy_time;
119
120 cur_wall_time = jiffies64_to_cputime64(get_jiffies_64());
121
122 busy_time = kcpustat_cpu(cpu).cpustat[CPUTIME_USER];
123 busy_time += kcpustat_cpu(cpu).cpustat[CPUTIME_SYSTEM];
124 busy_time += kcpustat_cpu(cpu).cpustat[CPUTIME_IRQ];
125 busy_time += kcpustat_cpu(cpu).cpustat[CPUTIME_SOFTIRQ];
126 busy_time += kcpustat_cpu(cpu).cpustat[CPUTIME_STEAL];
127 busy_time += kcpustat_cpu(cpu).cpustat[CPUTIME_NICE];
128
129 idle_time = cur_wall_time - busy_time;
130 if (wall)
131 *wall = cputime_to_usecs(cur_wall_time);
132
133 return cputime_to_usecs(idle_time);
134}
135
136u64 get_cpu_idle_time(unsigned int cpu, u64 *wall, int io_busy)
137{
138 u64 idle_time = get_cpu_idle_time_us(cpu, io_busy ? wall : NULL);
139
140 if (idle_time == -1ULL)
141 return get_cpu_idle_time_jiffy(cpu, wall);
142 else if (!io_busy)
143 idle_time += get_cpu_iowait_time_us(cpu, wall);
144
145 return idle_time;
146}
147EXPORT_SYMBOL_GPL(get_cpu_idle_time);
148
Viresh Kumar70e9e772013-10-03 20:29:07 +0530149/*
150 * This is a generic cpufreq init() routine which can be used by cpufreq
151 * drivers of SMP systems. It will do following:
152 * - validate & show freq table passed
153 * - set policies transition latency
154 * - policy->cpus with all possible CPUs
155 */
156int cpufreq_generic_init(struct cpufreq_policy *policy,
157 struct cpufreq_frequency_table *table,
158 unsigned int transition_latency)
159{
160 int ret;
161
162 ret = cpufreq_table_validate_and_show(policy, table);
163 if (ret) {
164 pr_err("%s: invalid frequency table: %d\n", __func__, ret);
165 return ret;
166 }
167
168 policy->cpuinfo.transition_latency = transition_latency;
169
170 /*
171 * The driver only supports the SMP configuartion where all processors
172 * share the clock and voltage and clock.
173 */
174 cpumask_setall(policy->cpus);
175
176 return 0;
177}
178EXPORT_SYMBOL_GPL(cpufreq_generic_init);
179
Viresh Kumar652ed952014-01-09 20:38:43 +0530180unsigned int cpufreq_generic_get(unsigned int cpu)
181{
182 struct cpufreq_policy *policy = per_cpu(cpufreq_cpu_data, cpu);
183
184 if (!policy || IS_ERR(policy->clk)) {
Joe Perchese837f9b2014-03-11 10:03:00 -0700185 pr_err("%s: No %s associated to cpu: %d\n",
186 __func__, policy ? "clk" : "policy", cpu);
Viresh Kumar652ed952014-01-09 20:38:43 +0530187 return 0;
188 }
189
190 return clk_get_rate(policy->clk) / 1000;
191}
192EXPORT_SYMBOL_GPL(cpufreq_generic_get);
193
Viresh Kumare0b31652014-03-10 14:53:33 +0530194/* Only for cpufreq core internal use */
195struct cpufreq_policy *cpufreq_cpu_get_raw(unsigned int cpu)
196{
197 return per_cpu(cpufreq_cpu_data, cpu);
198}
199
Viresh Kumar6eed9402013-08-06 22:53:11 +0530200struct cpufreq_policy *cpufreq_cpu_get(unsigned int cpu)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700201{
Viresh Kumar6eed9402013-08-06 22:53:11 +0530202 struct cpufreq_policy *policy = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700203 unsigned long flags;
204
Viresh Kumar6eed9402013-08-06 22:53:11 +0530205 if (cpufreq_disabled() || (cpu >= nr_cpu_ids))
206 return NULL;
207
208 if (!down_read_trylock(&cpufreq_rwsem))
209 return NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700210
211 /* get the cpufreq driver */
Nathan Zimmer0d1857a2013-02-22 16:24:34 +0000212 read_lock_irqsave(&cpufreq_driver_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700213
Viresh Kumar6eed9402013-08-06 22:53:11 +0530214 if (cpufreq_driver) {
215 /* get the CPU */
216 policy = per_cpu(cpufreq_cpu_data, cpu);
217 if (policy)
218 kobject_get(&policy->kobj);
219 }
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +0200220
Viresh Kumar6eed9402013-08-06 22:53:11 +0530221 read_unlock_irqrestore(&cpufreq_driver_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700222
Viresh Kumar3a3e9e02013-08-06 22:53:05 +0530223 if (!policy)
Viresh Kumar6eed9402013-08-06 22:53:11 +0530224 up_read(&cpufreq_rwsem);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700225
Viresh Kumar3a3e9e02013-08-06 22:53:05 +0530226 return policy;
Stephen Boyda9144432012-07-20 18:14:38 +0000227}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700228EXPORT_SYMBOL_GPL(cpufreq_cpu_get);
229
Viresh Kumar3a3e9e02013-08-06 22:53:05 +0530230void cpufreq_cpu_put(struct cpufreq_policy *policy)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700231{
Dirk Brandewied5aaffa2013-01-17 16:22:21 +0000232 if (cpufreq_disabled())
233 return;
234
Viresh Kumar6eed9402013-08-06 22:53:11 +0530235 kobject_put(&policy->kobj);
236 up_read(&cpufreq_rwsem);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700237}
238EXPORT_SYMBOL_GPL(cpufreq_cpu_put);
239
Linus Torvalds1da177e2005-04-16 15:20:36 -0700240/*********************************************************************
Linus Torvalds1da177e2005-04-16 15:20:36 -0700241 * EXTERNALLY AFFECTING FREQUENCY CHANGES *
242 *********************************************************************/
243
244/**
245 * adjust_jiffies - adjust the system "loops_per_jiffy"
246 *
247 * This function alters the system "loops_per_jiffy" for the clock
248 * speed change. Note that loops_per_jiffy cannot be updated on SMP
Dave Jones32ee8c32006-02-28 00:43:23 -0500249 * systems as each CPU might be scaled differently. So, use the arch
Linus Torvalds1da177e2005-04-16 15:20:36 -0700250 * per-CPU loops_per_jiffy value wherever possible.
251 */
252#ifndef CONFIG_SMP
253static unsigned long l_p_j_ref;
Viresh Kumarbb176f72013-06-19 14:19:33 +0530254static unsigned int l_p_j_ref_freq;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700255
Arjan van de Ven858119e2006-01-14 13:20:43 -0800256static void adjust_jiffies(unsigned long val, struct cpufreq_freqs *ci)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700257{
258 if (ci->flags & CPUFREQ_CONST_LOOPS)
259 return;
260
261 if (!l_p_j_ref_freq) {
262 l_p_j_ref = loops_per_jiffy;
263 l_p_j_ref_freq = ci->old;
Joe Perchese837f9b2014-03-11 10:03:00 -0700264 pr_debug("saving %lu as reference value for loops_per_jiffy; freq is %u kHz\n",
265 l_p_j_ref, l_p_j_ref_freq);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700266 }
Viresh Kumar0b443ea2014-03-19 11:24:58 +0530267 if (val == CPUFREQ_POSTCHANGE && ci->old != ci->new) {
Gautham R Shenoye08f5f52006-10-26 16:20:58 +0530268 loops_per_jiffy = cpufreq_scale(l_p_j_ref, l_p_j_ref_freq,
269 ci->new);
Joe Perchese837f9b2014-03-11 10:03:00 -0700270 pr_debug("scaling loops_per_jiffy to %lu for frequency %u kHz\n",
271 loops_per_jiffy, ci->new);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700272 }
273}
274#else
Gautham R Shenoye08f5f52006-10-26 16:20:58 +0530275static inline void adjust_jiffies(unsigned long val, struct cpufreq_freqs *ci)
276{
277 return;
278}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700279#endif
280
Viresh Kumar0956df9c2013-06-19 14:19:34 +0530281static void __cpufreq_notify_transition(struct cpufreq_policy *policy,
Viresh Kumarb43a7ff2013-03-24 11:56:43 +0530282 struct cpufreq_freqs *freqs, unsigned int state)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700283{
284 BUG_ON(irqs_disabled());
285
Dirk Brandewied5aaffa2013-01-17 16:22:21 +0000286 if (cpufreq_disabled())
287 return;
288
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +0200289 freqs->flags = cpufreq_driver->flags;
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +0200290 pr_debug("notification %u of frequency transition to %u kHz\n",
Joe Perchese837f9b2014-03-11 10:03:00 -0700291 state, freqs->new);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700292
Linus Torvalds1da177e2005-04-16 15:20:36 -0700293 switch (state) {
Dave Jonese4472cb2006-01-31 15:53:55 -0800294
Linus Torvalds1da177e2005-04-16 15:20:36 -0700295 case CPUFREQ_PRECHANGE:
Dave Jones32ee8c32006-02-28 00:43:23 -0500296 /* detect if the driver reported a value as "old frequency"
Dave Jonese4472cb2006-01-31 15:53:55 -0800297 * which is not equal to what the cpufreq core thinks is
298 * "old frequency".
Linus Torvalds1da177e2005-04-16 15:20:36 -0700299 */
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +0200300 if (!(cpufreq_driver->flags & CPUFREQ_CONST_LOOPS)) {
Dave Jonese4472cb2006-01-31 15:53:55 -0800301 if ((policy) && (policy->cpu == freqs->cpu) &&
302 (policy->cur) && (policy->cur != freqs->old)) {
Joe Perchese837f9b2014-03-11 10:03:00 -0700303 pr_debug("Warning: CPU frequency is %u, cpufreq assumed %u kHz\n",
304 freqs->old, policy->cur);
Dave Jonese4472cb2006-01-31 15:53:55 -0800305 freqs->old = policy->cur;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700306 }
307 }
Alan Sternb4dfdbb2006-10-04 02:17:06 -0700308 srcu_notifier_call_chain(&cpufreq_transition_notifier_list,
Alan Sterne041c682006-03-27 01:16:30 -0800309 CPUFREQ_PRECHANGE, freqs);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700310 adjust_jiffies(CPUFREQ_PRECHANGE, freqs);
311 break;
Dave Jonese4472cb2006-01-31 15:53:55 -0800312
Linus Torvalds1da177e2005-04-16 15:20:36 -0700313 case CPUFREQ_POSTCHANGE:
314 adjust_jiffies(CPUFREQ_POSTCHANGE, freqs);
Joe Perchese837f9b2014-03-11 10:03:00 -0700315 pr_debug("FREQ: %lu - CPU: %lu\n",
316 (unsigned long)freqs->new, (unsigned long)freqs->cpu);
Thomas Renninger25e41932011-01-03 17:50:44 +0100317 trace_cpu_frequency(freqs->new, freqs->cpu);
Alan Sternb4dfdbb2006-10-04 02:17:06 -0700318 srcu_notifier_call_chain(&cpufreq_transition_notifier_list,
Alan Sterne041c682006-03-27 01:16:30 -0800319 CPUFREQ_POSTCHANGE, freqs);
Dave Jonese4472cb2006-01-31 15:53:55 -0800320 if (likely(policy) && likely(policy->cpu == freqs->cpu))
321 policy->cur = freqs->new;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700322 break;
323 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700324}
Viresh Kumarbb176f72013-06-19 14:19:33 +0530325
Viresh Kumarb43a7ff2013-03-24 11:56:43 +0530326/**
327 * cpufreq_notify_transition - call notifier chain and adjust_jiffies
328 * on frequency transition.
329 *
330 * This function calls the transition notifiers and the "adjust_jiffies"
331 * function. It is called twice on all CPU frequency changes that have
332 * external effects.
333 */
334void cpufreq_notify_transition(struct cpufreq_policy *policy,
335 struct cpufreq_freqs *freqs, unsigned int state)
336{
337 for_each_cpu(freqs->cpu, policy->cpus)
338 __cpufreq_notify_transition(policy, freqs, state);
339}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700340EXPORT_SYMBOL_GPL(cpufreq_notify_transition);
341
Viresh Kumarf7ba3b42013-12-02 11:04:12 +0530342/* Do post notifications when there are chances that transition has failed */
343void cpufreq_notify_post_transition(struct cpufreq_policy *policy,
344 struct cpufreq_freqs *freqs, int transition_failed)
345{
346 cpufreq_notify_transition(policy, freqs, CPUFREQ_POSTCHANGE);
347 if (!transition_failed)
348 return;
349
350 swap(freqs->old, freqs->new);
351 cpufreq_notify_transition(policy, freqs, CPUFREQ_PRECHANGE);
352 cpufreq_notify_transition(policy, freqs, CPUFREQ_POSTCHANGE);
353}
354EXPORT_SYMBOL_GPL(cpufreq_notify_post_transition);
355
Linus Torvalds1da177e2005-04-16 15:20:36 -0700356
Linus Torvalds1da177e2005-04-16 15:20:36 -0700357/*********************************************************************
358 * SYSFS INTERFACE *
359 *********************************************************************/
Rashika Kheria8a5c74a2014-02-26 22:12:42 +0530360static ssize_t show_boost(struct kobject *kobj,
Lukasz Majewski6f19efc2013-12-20 15:24:49 +0100361 struct attribute *attr, char *buf)
362{
363 return sprintf(buf, "%d\n", cpufreq_driver->boost_enabled);
364}
365
366static ssize_t store_boost(struct kobject *kobj, struct attribute *attr,
367 const char *buf, size_t count)
368{
369 int ret, enable;
370
371 ret = sscanf(buf, "%d", &enable);
372 if (ret != 1 || enable < 0 || enable > 1)
373 return -EINVAL;
374
375 if (cpufreq_boost_trigger_state(enable)) {
Joe Perchese837f9b2014-03-11 10:03:00 -0700376 pr_err("%s: Cannot %s BOOST!\n",
377 __func__, enable ? "enable" : "disable");
Lukasz Majewski6f19efc2013-12-20 15:24:49 +0100378 return -EINVAL;
379 }
380
Joe Perchese837f9b2014-03-11 10:03:00 -0700381 pr_debug("%s: cpufreq BOOST %s\n",
382 __func__, enable ? "enabled" : "disabled");
Lukasz Majewski6f19efc2013-12-20 15:24:49 +0100383
384 return count;
385}
386define_one_global_rw(boost);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700387
Jeremy Fitzhardinge3bcb09a2006-07-06 12:30:26 -0700388static struct cpufreq_governor *__find_governor(const char *str_governor)
389{
390 struct cpufreq_governor *t;
391
392 list_for_each_entry(t, &cpufreq_governor_list, governor_list)
Dave Jones29464f22009-01-18 01:37:11 -0500393 if (!strnicmp(str_governor, t->name, CPUFREQ_NAME_LEN))
Jeremy Fitzhardinge3bcb09a2006-07-06 12:30:26 -0700394 return t;
395
396 return NULL;
397}
398
Linus Torvalds1da177e2005-04-16 15:20:36 -0700399/**
400 * cpufreq_parse_governor - parse a governor string
401 */
Dave Jones905d77c2008-03-05 14:28:32 -0500402static int cpufreq_parse_governor(char *str_governor, unsigned int *policy,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700403 struct cpufreq_governor **governor)
404{
Jeremy Fitzhardinge3bcb09a2006-07-06 12:30:26 -0700405 int err = -EINVAL;
406
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +0200407 if (!cpufreq_driver)
Jeremy Fitzhardinge3bcb09a2006-07-06 12:30:26 -0700408 goto out;
409
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +0200410 if (cpufreq_driver->setpolicy) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700411 if (!strnicmp(str_governor, "performance", CPUFREQ_NAME_LEN)) {
412 *policy = CPUFREQ_POLICY_PERFORMANCE;
Jeremy Fitzhardinge3bcb09a2006-07-06 12:30:26 -0700413 err = 0;
Gautham R Shenoye08f5f52006-10-26 16:20:58 +0530414 } else if (!strnicmp(str_governor, "powersave",
415 CPUFREQ_NAME_LEN)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700416 *policy = CPUFREQ_POLICY_POWERSAVE;
Jeremy Fitzhardinge3bcb09a2006-07-06 12:30:26 -0700417 err = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700418 }
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +0530419 } else if (has_target()) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700420 struct cpufreq_governor *t;
Jeremy Fitzhardinge3bcb09a2006-07-06 12:30:26 -0700421
akpm@osdl.org3fc54d32006-01-13 15:54:22 -0800422 mutex_lock(&cpufreq_governor_mutex);
Jeremy Fitzhardinge3bcb09a2006-07-06 12:30:26 -0700423
424 t = __find_governor(str_governor);
425
Jeremy Fitzhardingeea714972006-07-06 12:32:01 -0700426 if (t == NULL) {
Kees Cook1a8e1462011-05-04 08:38:56 -0700427 int ret;
Jeremy Fitzhardingeea714972006-07-06 12:32:01 -0700428
Kees Cook1a8e1462011-05-04 08:38:56 -0700429 mutex_unlock(&cpufreq_governor_mutex);
430 ret = request_module("cpufreq_%s", str_governor);
431 mutex_lock(&cpufreq_governor_mutex);
Jeremy Fitzhardingeea714972006-07-06 12:32:01 -0700432
Kees Cook1a8e1462011-05-04 08:38:56 -0700433 if (ret == 0)
434 t = __find_governor(str_governor);
Jeremy Fitzhardingeea714972006-07-06 12:32:01 -0700435 }
436
Jeremy Fitzhardinge3bcb09a2006-07-06 12:30:26 -0700437 if (t != NULL) {
438 *governor = t;
439 err = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700440 }
Jeremy Fitzhardinge3bcb09a2006-07-06 12:30:26 -0700441
akpm@osdl.org3fc54d32006-01-13 15:54:22 -0800442 mutex_unlock(&cpufreq_governor_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700443 }
Dave Jones29464f22009-01-18 01:37:11 -0500444out:
Jeremy Fitzhardinge3bcb09a2006-07-06 12:30:26 -0700445 return err;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700446}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700447
Linus Torvalds1da177e2005-04-16 15:20:36 -0700448/**
Gautham R Shenoye08f5f52006-10-26 16:20:58 +0530449 * cpufreq_per_cpu_attr_read() / show_##file_name() -
450 * print out cpufreq information
Linus Torvalds1da177e2005-04-16 15:20:36 -0700451 *
452 * Write out information from cpufreq_driver->policy[cpu]; object must be
453 * "unsigned int".
454 */
455
Dave Jones32ee8c32006-02-28 00:43:23 -0500456#define show_one(file_name, object) \
457static ssize_t show_##file_name \
Dave Jones905d77c2008-03-05 14:28:32 -0500458(struct cpufreq_policy *policy, char *buf) \
Dave Jones32ee8c32006-02-28 00:43:23 -0500459{ \
Dave Jones29464f22009-01-18 01:37:11 -0500460 return sprintf(buf, "%u\n", policy->object); \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700461}
462
463show_one(cpuinfo_min_freq, cpuinfo.min_freq);
464show_one(cpuinfo_max_freq, cpuinfo.max_freq);
Thomas Renningered129782009-02-04 01:17:41 +0100465show_one(cpuinfo_transition_latency, cpuinfo.transition_latency);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700466show_one(scaling_min_freq, min);
467show_one(scaling_max_freq, max);
468show_one(scaling_cur_freq, cur);
469
Viresh Kumar037ce832013-10-02 14:13:16 +0530470static int cpufreq_set_policy(struct cpufreq_policy *policy,
Viresh Kumar3a3e9e02013-08-06 22:53:05 +0530471 struct cpufreq_policy *new_policy);
Thomas Renninger7970e082006-04-13 15:14:04 +0200472
Linus Torvalds1da177e2005-04-16 15:20:36 -0700473/**
474 * cpufreq_per_cpu_attr_write() / store_##file_name() - sysfs write access
475 */
476#define store_one(file_name, object) \
477static ssize_t store_##file_name \
Dave Jones905d77c2008-03-05 14:28:32 -0500478(struct cpufreq_policy *policy, const char *buf, size_t count) \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700479{ \
Srivatsa S. Bhat5136fa52013-09-07 01:24:06 +0530480 int ret; \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700481 struct cpufreq_policy new_policy; \
482 \
483 ret = cpufreq_get_policy(&new_policy, policy->cpu); \
484 if (ret) \
485 return -EINVAL; \
486 \
Dave Jones29464f22009-01-18 01:37:11 -0500487 ret = sscanf(buf, "%u", &new_policy.object); \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700488 if (ret != 1) \
489 return -EINVAL; \
490 \
Viresh Kumar037ce832013-10-02 14:13:16 +0530491 ret = cpufreq_set_policy(policy, &new_policy); \
Thomas Renninger7970e082006-04-13 15:14:04 +0200492 policy->user_policy.object = policy->object; \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700493 \
494 return ret ? ret : count; \
495}
496
Dave Jones29464f22009-01-18 01:37:11 -0500497store_one(scaling_min_freq, min);
498store_one(scaling_max_freq, max);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700499
500/**
501 * show_cpuinfo_cur_freq - current CPU frequency as detected by hardware
502 */
Dave Jones905d77c2008-03-05 14:28:32 -0500503static ssize_t show_cpuinfo_cur_freq(struct cpufreq_policy *policy,
504 char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700505{
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -0800506 unsigned int cur_freq = __cpufreq_get(policy->cpu);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700507 if (!cur_freq)
508 return sprintf(buf, "<unknown>");
509 return sprintf(buf, "%u\n", cur_freq);
510}
511
Linus Torvalds1da177e2005-04-16 15:20:36 -0700512/**
513 * show_scaling_governor - show the current policy for the specified CPU
514 */
Dave Jones905d77c2008-03-05 14:28:32 -0500515static ssize_t show_scaling_governor(struct cpufreq_policy *policy, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700516{
Dave Jones29464f22009-01-18 01:37:11 -0500517 if (policy->policy == CPUFREQ_POLICY_POWERSAVE)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700518 return sprintf(buf, "powersave\n");
519 else if (policy->policy == CPUFREQ_POLICY_PERFORMANCE)
520 return sprintf(buf, "performance\n");
521 else if (policy->governor)
viresh kumar4b972f02012-10-23 01:23:43 +0200522 return scnprintf(buf, CPUFREQ_NAME_PLEN, "%s\n",
Dave Jones29464f22009-01-18 01:37:11 -0500523 policy->governor->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700524 return -EINVAL;
525}
526
Linus Torvalds1da177e2005-04-16 15:20:36 -0700527/**
528 * store_scaling_governor - store policy for the specified CPU
529 */
Dave Jones905d77c2008-03-05 14:28:32 -0500530static ssize_t store_scaling_governor(struct cpufreq_policy *policy,
531 const char *buf, size_t count)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700532{
Srivatsa S. Bhat5136fa52013-09-07 01:24:06 +0530533 int ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700534 char str_governor[16];
535 struct cpufreq_policy new_policy;
536
537 ret = cpufreq_get_policy(&new_policy, policy->cpu);
538 if (ret)
539 return ret;
540
Dave Jones29464f22009-01-18 01:37:11 -0500541 ret = sscanf(buf, "%15s", str_governor);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700542 if (ret != 1)
543 return -EINVAL;
544
Gautham R Shenoye08f5f52006-10-26 16:20:58 +0530545 if (cpufreq_parse_governor(str_governor, &new_policy.policy,
546 &new_policy.governor))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700547 return -EINVAL;
548
Viresh Kumar037ce832013-10-02 14:13:16 +0530549 ret = cpufreq_set_policy(policy, &new_policy);
Thomas Renninger7970e082006-04-13 15:14:04 +0200550
551 policy->user_policy.policy = policy->policy;
552 policy->user_policy.governor = policy->governor;
Thomas Renninger7970e082006-04-13 15:14:04 +0200553
Gautham R Shenoye08f5f52006-10-26 16:20:58 +0530554 if (ret)
555 return ret;
556 else
557 return count;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700558}
559
560/**
561 * show_scaling_driver - show the cpufreq driver currently loaded
562 */
Dave Jones905d77c2008-03-05 14:28:32 -0500563static ssize_t show_scaling_driver(struct cpufreq_policy *policy, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700564{
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +0200565 return scnprintf(buf, CPUFREQ_NAME_PLEN, "%s\n", cpufreq_driver->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700566}
567
568/**
569 * show_scaling_available_governors - show the available CPUfreq governors
570 */
Dave Jones905d77c2008-03-05 14:28:32 -0500571static ssize_t show_scaling_available_governors(struct cpufreq_policy *policy,
572 char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700573{
574 ssize_t i = 0;
575 struct cpufreq_governor *t;
576
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +0530577 if (!has_target()) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700578 i += sprintf(buf, "performance powersave");
579 goto out;
580 }
581
582 list_for_each_entry(t, &cpufreq_governor_list, governor_list) {
Dave Jones29464f22009-01-18 01:37:11 -0500583 if (i >= (ssize_t) ((PAGE_SIZE / sizeof(char))
584 - (CPUFREQ_NAME_LEN + 2)))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700585 goto out;
viresh kumar4b972f02012-10-23 01:23:43 +0200586 i += scnprintf(&buf[i], CPUFREQ_NAME_PLEN, "%s ", t->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700587 }
Dave Jones7d5e3502006-02-02 17:03:42 -0500588out:
Linus Torvalds1da177e2005-04-16 15:20:36 -0700589 i += sprintf(&buf[i], "\n");
590 return i;
591}
Darrick J. Wonge8628dd2008-04-18 13:31:12 -0700592
Lan Tianyuf4fd3792013-06-27 15:08:54 +0800593ssize_t cpufreq_show_cpus(const struct cpumask *mask, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700594{
595 ssize_t i = 0;
596 unsigned int cpu;
597
Rusty Russell835481d2009-01-04 05:18:06 -0800598 for_each_cpu(cpu, mask) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700599 if (i)
600 i += scnprintf(&buf[i], (PAGE_SIZE - i - 2), " ");
601 i += scnprintf(&buf[i], (PAGE_SIZE - i - 2), "%u", cpu);
602 if (i >= (PAGE_SIZE - 5))
Dave Jones29464f22009-01-18 01:37:11 -0500603 break;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700604 }
605 i += sprintf(&buf[i], "\n");
606 return i;
607}
Lan Tianyuf4fd3792013-06-27 15:08:54 +0800608EXPORT_SYMBOL_GPL(cpufreq_show_cpus);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700609
Darrick J. Wonge8628dd2008-04-18 13:31:12 -0700610/**
611 * show_related_cpus - show the CPUs affected by each transition even if
612 * hw coordination is in use
613 */
614static ssize_t show_related_cpus(struct cpufreq_policy *policy, char *buf)
615{
Lan Tianyuf4fd3792013-06-27 15:08:54 +0800616 return cpufreq_show_cpus(policy->related_cpus, buf);
Darrick J. Wonge8628dd2008-04-18 13:31:12 -0700617}
618
619/**
620 * show_affected_cpus - show the CPUs affected by each transition
621 */
622static ssize_t show_affected_cpus(struct cpufreq_policy *policy, char *buf)
623{
Lan Tianyuf4fd3792013-06-27 15:08:54 +0800624 return cpufreq_show_cpus(policy->cpus, buf);
Darrick J. Wonge8628dd2008-04-18 13:31:12 -0700625}
626
Venki Pallipadi9e769882007-10-26 10:18:21 -0700627static ssize_t store_scaling_setspeed(struct cpufreq_policy *policy,
Dave Jones905d77c2008-03-05 14:28:32 -0500628 const char *buf, size_t count)
Venki Pallipadi9e769882007-10-26 10:18:21 -0700629{
630 unsigned int freq = 0;
631 unsigned int ret;
632
CHIKAMA masaki879000f2008-06-05 22:46:33 -0700633 if (!policy->governor || !policy->governor->store_setspeed)
Venki Pallipadi9e769882007-10-26 10:18:21 -0700634 return -EINVAL;
635
636 ret = sscanf(buf, "%u", &freq);
637 if (ret != 1)
638 return -EINVAL;
639
640 policy->governor->store_setspeed(policy, freq);
641
642 return count;
643}
644
645static ssize_t show_scaling_setspeed(struct cpufreq_policy *policy, char *buf)
646{
CHIKAMA masaki879000f2008-06-05 22:46:33 -0700647 if (!policy->governor || !policy->governor->show_setspeed)
Venki Pallipadi9e769882007-10-26 10:18:21 -0700648 return sprintf(buf, "<unsupported>\n");
649
650 return policy->governor->show_setspeed(policy, buf);
651}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700652
Thomas Renningere2f74f32009-11-19 12:31:01 +0100653/**
viresh kumar8bf1ac722012-10-23 01:23:33 +0200654 * show_bios_limit - show the current cpufreq HW/BIOS limitation
Thomas Renningere2f74f32009-11-19 12:31:01 +0100655 */
656static ssize_t show_bios_limit(struct cpufreq_policy *policy, char *buf)
657{
658 unsigned int limit;
659 int ret;
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +0200660 if (cpufreq_driver->bios_limit) {
661 ret = cpufreq_driver->bios_limit(policy->cpu, &limit);
Thomas Renningere2f74f32009-11-19 12:31:01 +0100662 if (!ret)
663 return sprintf(buf, "%u\n", limit);
664 }
665 return sprintf(buf, "%u\n", policy->cpuinfo.max_freq);
666}
667
Borislav Petkov6dad2a22010-03-31 21:56:46 +0200668cpufreq_freq_attr_ro_perm(cpuinfo_cur_freq, 0400);
669cpufreq_freq_attr_ro(cpuinfo_min_freq);
670cpufreq_freq_attr_ro(cpuinfo_max_freq);
671cpufreq_freq_attr_ro(cpuinfo_transition_latency);
672cpufreq_freq_attr_ro(scaling_available_governors);
673cpufreq_freq_attr_ro(scaling_driver);
674cpufreq_freq_attr_ro(scaling_cur_freq);
675cpufreq_freq_attr_ro(bios_limit);
676cpufreq_freq_attr_ro(related_cpus);
677cpufreq_freq_attr_ro(affected_cpus);
678cpufreq_freq_attr_rw(scaling_min_freq);
679cpufreq_freq_attr_rw(scaling_max_freq);
680cpufreq_freq_attr_rw(scaling_governor);
681cpufreq_freq_attr_rw(scaling_setspeed);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700682
Dave Jones905d77c2008-03-05 14:28:32 -0500683static struct attribute *default_attrs[] = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700684 &cpuinfo_min_freq.attr,
685 &cpuinfo_max_freq.attr,
Thomas Renningered129782009-02-04 01:17:41 +0100686 &cpuinfo_transition_latency.attr,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700687 &scaling_min_freq.attr,
688 &scaling_max_freq.attr,
689 &affected_cpus.attr,
Darrick J. Wonge8628dd2008-04-18 13:31:12 -0700690 &related_cpus.attr,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700691 &scaling_governor.attr,
692 &scaling_driver.attr,
693 &scaling_available_governors.attr,
Venki Pallipadi9e769882007-10-26 10:18:21 -0700694 &scaling_setspeed.attr,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700695 NULL
696};
697
Dave Jones29464f22009-01-18 01:37:11 -0500698#define to_policy(k) container_of(k, struct cpufreq_policy, kobj)
699#define to_attr(a) container_of(a, struct freq_attr, attr)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700700
Dave Jones29464f22009-01-18 01:37:11 -0500701static ssize_t show(struct kobject *kobj, struct attribute *attr, char *buf)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700702{
Dave Jones905d77c2008-03-05 14:28:32 -0500703 struct cpufreq_policy *policy = to_policy(kobj);
704 struct freq_attr *fattr = to_attr(attr);
Viresh Kumar1b750e32013-10-02 14:13:09 +0530705 ssize_t ret;
Viresh Kumar6eed9402013-08-06 22:53:11 +0530706
707 if (!down_read_trylock(&cpufreq_rwsem))
Viresh Kumar1b750e32013-10-02 14:13:09 +0530708 return -EINVAL;
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -0800709
viresh kumarad7722d2013-10-18 19:10:15 +0530710 down_read(&policy->rwsem);
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -0800711
Gautham R Shenoye08f5f52006-10-26 16:20:58 +0530712 if (fattr->show)
713 ret = fattr->show(policy, buf);
714 else
715 ret = -EIO;
716
viresh kumarad7722d2013-10-18 19:10:15 +0530717 up_read(&policy->rwsem);
Viresh Kumar6eed9402013-08-06 22:53:11 +0530718 up_read(&cpufreq_rwsem);
Viresh Kumar1b750e32013-10-02 14:13:09 +0530719
Linus Torvalds1da177e2005-04-16 15:20:36 -0700720 return ret;
721}
722
Dave Jones905d77c2008-03-05 14:28:32 -0500723static ssize_t store(struct kobject *kobj, struct attribute *attr,
724 const char *buf, size_t count)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700725{
Dave Jones905d77c2008-03-05 14:28:32 -0500726 struct cpufreq_policy *policy = to_policy(kobj);
727 struct freq_attr *fattr = to_attr(attr);
Dave Jonesa07530b2008-03-05 14:22:25 -0500728 ssize_t ret = -EINVAL;
Viresh Kumar6eed9402013-08-06 22:53:11 +0530729
Srivatsa S. Bhat4f750c92013-09-07 01:23:43 +0530730 get_online_cpus();
731
732 if (!cpu_online(policy->cpu))
733 goto unlock;
734
Viresh Kumar6eed9402013-08-06 22:53:11 +0530735 if (!down_read_trylock(&cpufreq_rwsem))
Srivatsa S. Bhat4f750c92013-09-07 01:23:43 +0530736 goto unlock;
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -0800737
viresh kumarad7722d2013-10-18 19:10:15 +0530738 down_write(&policy->rwsem);
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -0800739
Gautham R Shenoye08f5f52006-10-26 16:20:58 +0530740 if (fattr->store)
741 ret = fattr->store(policy, buf, count);
742 else
743 ret = -EIO;
744
viresh kumarad7722d2013-10-18 19:10:15 +0530745 up_write(&policy->rwsem);
Viresh Kumar6eed9402013-08-06 22:53:11 +0530746
Viresh Kumar6eed9402013-08-06 22:53:11 +0530747 up_read(&cpufreq_rwsem);
Srivatsa S. Bhat4f750c92013-09-07 01:23:43 +0530748unlock:
749 put_online_cpus();
750
Linus Torvalds1da177e2005-04-16 15:20:36 -0700751 return ret;
752}
753
Dave Jones905d77c2008-03-05 14:28:32 -0500754static void cpufreq_sysfs_release(struct kobject *kobj)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700755{
Dave Jones905d77c2008-03-05 14:28:32 -0500756 struct cpufreq_policy *policy = to_policy(kobj);
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +0200757 pr_debug("last reference is dropped\n");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700758 complete(&policy->kobj_unregister);
759}
760
Emese Revfy52cf25d2010-01-19 02:58:23 +0100761static const struct sysfs_ops sysfs_ops = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700762 .show = show,
763 .store = store,
764};
765
766static struct kobj_type ktype_cpufreq = {
767 .sysfs_ops = &sysfs_ops,
768 .default_attrs = default_attrs,
769 .release = cpufreq_sysfs_release,
770};
771
Viresh Kumar2361be22013-05-17 16:09:09 +0530772struct kobject *cpufreq_global_kobject;
773EXPORT_SYMBOL(cpufreq_global_kobject);
774
775static int cpufreq_global_kobject_usage;
776
777int cpufreq_get_global_kobject(void)
778{
779 if (!cpufreq_global_kobject_usage++)
780 return kobject_add(cpufreq_global_kobject,
781 &cpu_subsys.dev_root->kobj, "%s", "cpufreq");
782
783 return 0;
784}
785EXPORT_SYMBOL(cpufreq_get_global_kobject);
786
787void cpufreq_put_global_kobject(void)
788{
789 if (!--cpufreq_global_kobject_usage)
790 kobject_del(cpufreq_global_kobject);
791}
792EXPORT_SYMBOL(cpufreq_put_global_kobject);
793
794int cpufreq_sysfs_create_file(const struct attribute *attr)
795{
796 int ret = cpufreq_get_global_kobject();
797
798 if (!ret) {
799 ret = sysfs_create_file(cpufreq_global_kobject, attr);
800 if (ret)
801 cpufreq_put_global_kobject();
802 }
803
804 return ret;
805}
806EXPORT_SYMBOL(cpufreq_sysfs_create_file);
807
808void cpufreq_sysfs_remove_file(const struct attribute *attr)
809{
810 sysfs_remove_file(cpufreq_global_kobject, attr);
811 cpufreq_put_global_kobject();
812}
813EXPORT_SYMBOL(cpufreq_sysfs_remove_file);
814
Dave Jones19d6f7e2009-07-08 17:35:39 -0400815/* symlink affected CPUs */
Viresh Kumar308b60e2013-07-31 14:35:14 +0200816static int cpufreq_add_dev_symlink(struct cpufreq_policy *policy)
Dave Jones19d6f7e2009-07-08 17:35:39 -0400817{
818 unsigned int j;
819 int ret = 0;
820
821 for_each_cpu(j, policy->cpus) {
Kay Sievers8a25a2f2011-12-21 14:29:42 -0800822 struct device *cpu_dev;
Dave Jones19d6f7e2009-07-08 17:35:39 -0400823
Viresh Kumar308b60e2013-07-31 14:35:14 +0200824 if (j == policy->cpu)
Dave Jones19d6f7e2009-07-08 17:35:39 -0400825 continue;
Dave Jones19d6f7e2009-07-08 17:35:39 -0400826
Viresh Kumare8fdde12013-07-31 14:31:33 +0200827 pr_debug("Adding link for CPU: %u\n", j);
Kay Sievers8a25a2f2011-12-21 14:29:42 -0800828 cpu_dev = get_cpu_device(j);
829 ret = sysfs_create_link(&cpu_dev->kobj, &policy->kobj,
Dave Jones19d6f7e2009-07-08 17:35:39 -0400830 "cpufreq");
Rafael J. Wysocki71c34612013-08-04 01:19:34 +0200831 if (ret)
832 break;
Dave Jones19d6f7e2009-07-08 17:35:39 -0400833 }
834 return ret;
835}
836
Viresh Kumar308b60e2013-07-31 14:35:14 +0200837static int cpufreq_add_dev_interface(struct cpufreq_policy *policy,
Kay Sievers8a25a2f2011-12-21 14:29:42 -0800838 struct device *dev)
Dave Jones909a6942009-07-08 18:05:42 -0400839{
840 struct freq_attr **drv_attr;
Dave Jones909a6942009-07-08 18:05:42 -0400841 int ret = 0;
Dave Jones909a6942009-07-08 18:05:42 -0400842
843 /* prepare interface data */
844 ret = kobject_init_and_add(&policy->kobj, &ktype_cpufreq,
Kay Sievers8a25a2f2011-12-21 14:29:42 -0800845 &dev->kobj, "cpufreq");
Dave Jones909a6942009-07-08 18:05:42 -0400846 if (ret)
847 return ret;
848
849 /* set up files for this cpu device */
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +0200850 drv_attr = cpufreq_driver->attr;
Dave Jones909a6942009-07-08 18:05:42 -0400851 while ((drv_attr) && (*drv_attr)) {
852 ret = sysfs_create_file(&policy->kobj, &((*drv_attr)->attr));
853 if (ret)
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +0200854 goto err_out_kobj_put;
Dave Jones909a6942009-07-08 18:05:42 -0400855 drv_attr++;
856 }
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +0200857 if (cpufreq_driver->get) {
Dave Jones909a6942009-07-08 18:05:42 -0400858 ret = sysfs_create_file(&policy->kobj, &cpuinfo_cur_freq.attr);
859 if (ret)
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +0200860 goto err_out_kobj_put;
Dave Jones909a6942009-07-08 18:05:42 -0400861 }
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +0530862 if (has_target()) {
Dave Jones909a6942009-07-08 18:05:42 -0400863 ret = sysfs_create_file(&policy->kobj, &scaling_cur_freq.attr);
864 if (ret)
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +0200865 goto err_out_kobj_put;
Dave Jones909a6942009-07-08 18:05:42 -0400866 }
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +0200867 if (cpufreq_driver->bios_limit) {
Thomas Renningere2f74f32009-11-19 12:31:01 +0100868 ret = sysfs_create_file(&policy->kobj, &bios_limit.attr);
869 if (ret)
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +0200870 goto err_out_kobj_put;
Thomas Renningere2f74f32009-11-19 12:31:01 +0100871 }
Dave Jones909a6942009-07-08 18:05:42 -0400872
Viresh Kumar308b60e2013-07-31 14:35:14 +0200873 ret = cpufreq_add_dev_symlink(policy);
Dave Jonesecf7e462009-07-08 18:48:47 -0400874 if (ret)
875 goto err_out_kobj_put;
876
Srivatsa S. Bhate18f1682013-07-30 04:24:23 +0530877 return ret;
878
879err_out_kobj_put:
880 kobject_put(&policy->kobj);
881 wait_for_completion(&policy->kobj_unregister);
882 return ret;
883}
884
885static void cpufreq_init_policy(struct cpufreq_policy *policy)
886{
viresh kumar6e2c89d2014-03-04 11:43:59 +0800887 struct cpufreq_governor *gov = NULL;
Srivatsa S. Bhate18f1682013-07-30 04:24:23 +0530888 struct cpufreq_policy new_policy;
889 int ret = 0;
890
Viresh Kumard5b73cd2013-08-06 22:53:06 +0530891 memcpy(&new_policy, policy, sizeof(*policy));
Jason Barona27a9ab2013-12-19 22:50:50 +0000892
viresh kumar6e2c89d2014-03-04 11:43:59 +0800893 /* Update governor of new_policy to the governor used before hotplug */
894 gov = __find_governor(per_cpu(cpufreq_cpu_governor, policy->cpu));
895 if (gov)
896 pr_debug("Restoring governor %s for cpu %d\n",
897 policy->governor->name, policy->cpu);
898 else
899 gov = CPUFREQ_DEFAULT_GOVERNOR;
900
901 new_policy.governor = gov;
902
Jason Barona27a9ab2013-12-19 22:50:50 +0000903 /* Use the default policy if its valid. */
904 if (cpufreq_driver->setpolicy)
viresh kumar6e2c89d2014-03-04 11:43:59 +0800905 cpufreq_parse_governor(gov->name, &new_policy.policy, NULL);
Dave Jonesecf7e462009-07-08 18:48:47 -0400906
907 /* set default policy */
Viresh Kumar037ce832013-10-02 14:13:16 +0530908 ret = cpufreq_set_policy(policy, &new_policy);
Dave Jonesecf7e462009-07-08 18:48:47 -0400909 if (ret) {
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +0200910 pr_debug("setting policy failed\n");
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +0200911 if (cpufreq_driver->exit)
912 cpufreq_driver->exit(policy);
Dave Jonesecf7e462009-07-08 18:48:47 -0400913 }
Dave Jones909a6942009-07-08 18:05:42 -0400914}
915
Viresh Kumarfcf80582013-01-29 14:39:08 +0000916#ifdef CONFIG_HOTPLUG_CPU
Viresh Kumard8d3b472013-08-04 01:20:07 +0200917static int cpufreq_add_policy_cpu(struct cpufreq_policy *policy,
Viresh Kumar42f921a2013-12-20 21:26:02 +0530918 unsigned int cpu, struct device *dev)
Viresh Kumarfcf80582013-01-29 14:39:08 +0000919{
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +0530920 int ret = 0;
Viresh Kumarfcf80582013-01-29 14:39:08 +0000921 unsigned long flags;
922
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +0530923 if (has_target()) {
Viresh Kumar3de9bde2013-08-06 22:53:13 +0530924 ret = __cpufreq_governor(policy, CPUFREQ_GOV_STOP);
925 if (ret) {
926 pr_err("%s: Failed to stop governor\n", __func__);
927 return ret;
928 }
929 }
Viresh Kumarfcf80582013-01-29 14:39:08 +0000930
viresh kumarad7722d2013-10-18 19:10:15 +0530931 down_write(&policy->rwsem);
Viresh Kumar2eaa3e22013-02-07 10:55:00 +0530932
Nathan Zimmer0d1857a2013-02-22 16:24:34 +0000933 write_lock_irqsave(&cpufreq_driver_lock, flags);
Viresh Kumar2eaa3e22013-02-07 10:55:00 +0530934
Viresh Kumarfcf80582013-01-29 14:39:08 +0000935 cpumask_set_cpu(cpu, policy->cpus);
936 per_cpu(cpufreq_cpu_data, cpu) = policy;
Nathan Zimmer0d1857a2013-02-22 16:24:34 +0000937 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
Viresh Kumarfcf80582013-01-29 14:39:08 +0000938
viresh kumarad7722d2013-10-18 19:10:15 +0530939 up_write(&policy->rwsem);
Viresh Kumar2eaa3e22013-02-07 10:55:00 +0530940
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +0530941 if (has_target()) {
Stratos Karafotise5c87b72014-03-19 23:29:17 +0200942 ret = __cpufreq_governor(policy, CPUFREQ_GOV_START);
943 if (!ret)
944 ret = __cpufreq_governor(policy, CPUFREQ_GOV_LIMITS);
945
946 if (ret) {
Viresh Kumar3de9bde2013-08-06 22:53:13 +0530947 pr_err("%s: Failed to start governor\n", __func__);
948 return ret;
949 }
Viresh Kumar820c6ca2013-04-22 00:48:03 +0200950 }
Viresh Kumarfcf80582013-01-29 14:39:08 +0000951
Viresh Kumar42f921a2013-12-20 21:26:02 +0530952 return sysfs_create_link(&dev->kobj, &policy->kobj, "cpufreq");
Viresh Kumarfcf80582013-01-29 14:39:08 +0000953}
954#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700955
Srivatsa S. Bhat84148092013-07-30 04:25:10 +0530956static struct cpufreq_policy *cpufreq_policy_restore(unsigned int cpu)
957{
958 struct cpufreq_policy *policy;
959 unsigned long flags;
960
Lan Tianyu44871c92013-09-11 15:05:05 +0800961 read_lock_irqsave(&cpufreq_driver_lock, flags);
Srivatsa S. Bhat84148092013-07-30 04:25:10 +0530962
963 policy = per_cpu(cpufreq_cpu_data_fallback, cpu);
964
Lan Tianyu44871c92013-09-11 15:05:05 +0800965 read_unlock_irqrestore(&cpufreq_driver_lock, flags);
Srivatsa S. Bhat84148092013-07-30 04:25:10 +0530966
viresh kumar6e2c89d2014-03-04 11:43:59 +0800967 policy->governor = NULL;
968
Srivatsa S. Bhat84148092013-07-30 04:25:10 +0530969 return policy;
970}
971
Srivatsa S. Bhate9698cc2013-07-30 04:24:11 +0530972static struct cpufreq_policy *cpufreq_policy_alloc(void)
973{
974 struct cpufreq_policy *policy;
975
976 policy = kzalloc(sizeof(*policy), GFP_KERNEL);
977 if (!policy)
978 return NULL;
979
980 if (!alloc_cpumask_var(&policy->cpus, GFP_KERNEL))
981 goto err_free_policy;
982
983 if (!zalloc_cpumask_var(&policy->related_cpus, GFP_KERNEL))
984 goto err_free_cpumask;
985
Lukasz Majewskic88a1f82013-08-06 22:53:08 +0530986 INIT_LIST_HEAD(&policy->policy_list);
viresh kumarad7722d2013-10-18 19:10:15 +0530987 init_rwsem(&policy->rwsem);
988
Srivatsa S. Bhate9698cc2013-07-30 04:24:11 +0530989 return policy;
990
991err_free_cpumask:
992 free_cpumask_var(policy->cpus);
993err_free_policy:
994 kfree(policy);
995
996 return NULL;
997}
998
Viresh Kumar42f921a2013-12-20 21:26:02 +0530999static void cpufreq_policy_put_kobj(struct cpufreq_policy *policy)
1000{
1001 struct kobject *kobj;
1002 struct completion *cmp;
1003
Viresh Kumarfcd7af92014-01-07 07:10:10 +05301004 blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
1005 CPUFREQ_REMOVE_POLICY, policy);
1006
Viresh Kumar42f921a2013-12-20 21:26:02 +05301007 down_read(&policy->rwsem);
1008 kobj = &policy->kobj;
1009 cmp = &policy->kobj_unregister;
1010 up_read(&policy->rwsem);
1011 kobject_put(kobj);
1012
1013 /*
1014 * We need to make sure that the underlying kobj is
1015 * actually not referenced anymore by anybody before we
1016 * proceed with unloading.
1017 */
1018 pr_debug("waiting for dropping of refcount\n");
1019 wait_for_completion(cmp);
1020 pr_debug("wait complete\n");
1021}
1022
Srivatsa S. Bhate9698cc2013-07-30 04:24:11 +05301023static void cpufreq_policy_free(struct cpufreq_policy *policy)
1024{
1025 free_cpumask_var(policy->related_cpus);
1026 free_cpumask_var(policy->cpus);
1027 kfree(policy);
1028}
1029
Srivatsa S. Bhat0d66b912013-09-12 01:42:59 +05301030static void update_policy_cpu(struct cpufreq_policy *policy, unsigned int cpu)
1031{
Srivatsa S. Bhat99ec8992013-09-12 17:29:09 +05301032 if (WARN_ON(cpu == policy->cpu))
Srivatsa S. Bhatcb38ed52013-09-12 01:43:42 +05301033 return;
1034
viresh kumarad7722d2013-10-18 19:10:15 +05301035 down_write(&policy->rwsem);
Viresh Kumar8efd5762013-09-17 10:22:11 +05301036
Srivatsa S. Bhat0d66b912013-09-12 01:42:59 +05301037 policy->last_cpu = policy->cpu;
1038 policy->cpu = cpu;
1039
viresh kumarad7722d2013-10-18 19:10:15 +05301040 up_write(&policy->rwsem);
Viresh Kumar8efd5762013-09-17 10:22:11 +05301041
Srivatsa S. Bhat0d66b912013-09-12 01:42:59 +05301042 blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
1043 CPUFREQ_UPDATE_POLICY_CPU, policy);
1044}
1045
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301046static int __cpufreq_add_dev(struct device *dev, struct subsys_interface *sif)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001047{
Viresh Kumarfcf80582013-01-29 14:39:08 +00001048 unsigned int j, cpu = dev->id;
Viresh Kumar65922462013-02-07 10:56:03 +05301049 int ret = -ENOMEM;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001050 struct cpufreq_policy *policy;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001051 unsigned long flags;
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301052 bool recover_policy = cpufreq_suspended;
Prarit Bhargava90e41ba2009-11-12 09:18:46 -05001053#ifdef CONFIG_HOTPLUG_CPU
Viresh Kumar1b274292013-08-20 12:08:26 +05301054 struct cpufreq_policy *tpolicy;
Prarit Bhargava90e41ba2009-11-12 09:18:46 -05001055#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07001056
Ashok Rajc32b6b82005-10-30 14:59:54 -08001057 if (cpu_is_offline(cpu))
1058 return 0;
1059
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02001060 pr_debug("adding CPU %u\n", cpu);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001061
1062#ifdef CONFIG_SMP
1063 /* check whether a different CPU already registered this
1064 * CPU because it is in the same boat. */
1065 policy = cpufreq_cpu_get(cpu);
1066 if (unlikely(policy)) {
Dave Jones8ff69732006-03-05 03:37:23 -05001067 cpufreq_cpu_put(policy);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001068 return 0;
1069 }
Li Zhong5025d622013-08-21 01:31:08 +02001070#endif
Viresh Kumarfcf80582013-01-29 14:39:08 +00001071
Viresh Kumar6eed9402013-08-06 22:53:11 +05301072 if (!down_read_trylock(&cpufreq_rwsem))
1073 return 0;
1074
Viresh Kumarfcf80582013-01-29 14:39:08 +00001075#ifdef CONFIG_HOTPLUG_CPU
1076 /* Check if this cpu was hot-unplugged earlier and has siblings */
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00001077 read_lock_irqsave(&cpufreq_driver_lock, flags);
Viresh Kumar1b274292013-08-20 12:08:26 +05301078 list_for_each_entry(tpolicy, &cpufreq_policy_list, policy_list) {
1079 if (cpumask_test_cpu(cpu, tpolicy->related_cpus)) {
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00001080 read_unlock_irqrestore(&cpufreq_driver_lock, flags);
Viresh Kumar42f921a2013-12-20 21:26:02 +05301081 ret = cpufreq_add_policy_cpu(tpolicy, cpu, dev);
Viresh Kumar6eed9402013-08-06 22:53:11 +05301082 up_read(&cpufreq_rwsem);
1083 return ret;
Viresh Kumar2eaa3e22013-02-07 10:55:00 +05301084 }
Viresh Kumarfcf80582013-01-29 14:39:08 +00001085 }
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00001086 read_unlock_irqrestore(&cpufreq_driver_lock, flags);
Viresh Kumarfcf80582013-01-29 14:39:08 +00001087#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -07001088
Rafael J. Wysocki72368d12013-12-27 01:07:11 +01001089 /*
1090 * Restore the saved policy when doing light-weight init and fall back
1091 * to the full init if that fails.
1092 */
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301093 policy = recover_policy ? cpufreq_policy_restore(cpu) : NULL;
Rafael J. Wysocki72368d12013-12-27 01:07:11 +01001094 if (!policy) {
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301095 recover_policy = false;
Srivatsa S. Bhat84148092013-07-30 04:25:10 +05301096 policy = cpufreq_policy_alloc();
Rafael J. Wysocki72368d12013-12-27 01:07:11 +01001097 if (!policy)
1098 goto nomem_out;
1099 }
Srivatsa S. Bhat0d66b912013-09-12 01:42:59 +05301100
1101 /*
1102 * In the resume path, since we restore a saved policy, the assignment
1103 * to policy->cpu is like an update of the existing policy, rather than
1104 * the creation of a brand new one. So we need to perform this update
1105 * by invoking update_policy_cpu().
1106 */
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301107 if (recover_policy && cpu != policy->cpu)
Srivatsa S. Bhat0d66b912013-09-12 01:42:59 +05301108 update_policy_cpu(policy, cpu);
1109 else
1110 policy->cpu = cpu;
1111
Rusty Russell835481d2009-01-04 05:18:06 -08001112 cpumask_copy(policy->cpus, cpumask_of(cpu));
Linus Torvalds1da177e2005-04-16 15:20:36 -07001113
Linus Torvalds1da177e2005-04-16 15:20:36 -07001114 init_completion(&policy->kobj_unregister);
David Howells65f27f32006-11-22 14:55:48 +00001115 INIT_WORK(&policy->update, handle_update);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001116
1117 /* call driver. From then on the cpufreq must be able
1118 * to accept all calls to ->verify and ->setpolicy for this CPU
1119 */
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02001120 ret = cpufreq_driver->init(policy);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001121 if (ret) {
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02001122 pr_debug("initialization failed\n");
Viresh Kumar2eaa3e22013-02-07 10:55:00 +05301123 goto err_set_policy_cpu;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001124 }
Viresh Kumar643ae6e2013-01-12 05:14:38 +00001125
Viresh Kumar5a7e56a2014-03-04 11:44:00 +08001126 /* related cpus should atleast have policy->cpus */
1127 cpumask_or(policy->related_cpus, policy->related_cpus, policy->cpus);
1128
1129 /*
1130 * affected cpus must always be the one, which are online. We aren't
1131 * managing offline cpus here.
1132 */
1133 cpumask_and(policy->cpus, policy->cpus, cpu_online_mask);
1134
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301135 if (!recover_policy) {
Viresh Kumar5a7e56a2014-03-04 11:44:00 +08001136 policy->user_policy.min = policy->min;
1137 policy->user_policy.max = policy->max;
1138 }
1139
Viresh Kumar4e97b632014-03-04 11:44:01 +08001140 down_write(&policy->rwsem);
Viresh Kumar652ed952014-01-09 20:38:43 +05301141 write_lock_irqsave(&cpufreq_driver_lock, flags);
1142 for_each_cpu(j, policy->cpus)
1143 per_cpu(cpufreq_cpu_data, j) = policy;
1144 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
1145
Rafael J. Wysocki2ed99e32014-03-12 21:49:33 +01001146 if (cpufreq_driver->get && !cpufreq_driver->setpolicy) {
Viresh Kumarda60ce92013-10-03 20:28:30 +05301147 policy->cur = cpufreq_driver->get(policy->cpu);
1148 if (!policy->cur) {
1149 pr_err("%s: ->get() failed\n", __func__);
1150 goto err_get_freq;
1151 }
1152 }
1153
Viresh Kumard3916692013-12-03 11:20:46 +05301154 /*
1155 * Sometimes boot loaders set CPU frequency to a value outside of
1156 * frequency table present with cpufreq core. In such cases CPU might be
1157 * unstable if it has to run on that frequency for long duration of time
1158 * and so its better to set it to a frequency which is specified in
1159 * freq-table. This also makes cpufreq stats inconsistent as
1160 * cpufreq-stats would fail to register because current frequency of CPU
1161 * isn't found in freq-table.
1162 *
1163 * Because we don't want this change to effect boot process badly, we go
1164 * for the next freq which is >= policy->cur ('cur' must be set by now,
1165 * otherwise we will end up setting freq to lowest of the table as 'cur'
1166 * is initialized to zero).
1167 *
1168 * We are passing target-freq as "policy->cur - 1" otherwise
1169 * __cpufreq_driver_target() would simply fail, as policy->cur will be
1170 * equal to target-freq.
1171 */
1172 if ((cpufreq_driver->flags & CPUFREQ_NEED_INITIAL_FREQ_CHECK)
1173 && has_target()) {
1174 /* Are we running at unknown frequency ? */
1175 ret = cpufreq_frequency_table_get_index(policy, policy->cur);
1176 if (ret == -EINVAL) {
1177 /* Warn user and fix it */
1178 pr_warn("%s: CPU%d: Running at unlisted freq: %u KHz\n",
1179 __func__, policy->cpu, policy->cur);
1180 ret = __cpufreq_driver_target(policy, policy->cur - 1,
1181 CPUFREQ_RELATION_L);
1182
1183 /*
1184 * Reaching here after boot in a few seconds may not
1185 * mean that system will remain stable at "unknown"
1186 * frequency for longer duration. Hence, a BUG_ON().
1187 */
1188 BUG_ON(ret);
1189 pr_warn("%s: CPU%d: Unlisted initial frequency changed to: %u KHz\n",
1190 __func__, policy->cpu, policy->cur);
1191 }
1192 }
1193
Thomas Renningera1531ac2008-07-29 22:32:58 -07001194 blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
1195 CPUFREQ_START, policy);
1196
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301197 if (!recover_policy) {
Viresh Kumar308b60e2013-07-31 14:35:14 +02001198 ret = cpufreq_add_dev_interface(policy, dev);
Srivatsa S. Bhata82fab22013-07-30 04:24:49 +05301199 if (ret)
1200 goto err_out_unregister;
Viresh Kumarfcd7af92014-01-07 07:10:10 +05301201 blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
1202 CPUFREQ_CREATE_POLICY, policy);
Srivatsa S. Bhata82fab22013-07-30 04:24:49 +05301203 }
Dave Jones8ff69732006-03-05 03:37:23 -05001204
Viresh Kumar9515f4d2013-08-20 12:08:23 +05301205 write_lock_irqsave(&cpufreq_driver_lock, flags);
1206 list_add(&policy->policy_list, &cpufreq_policy_list);
1207 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
1208
Srivatsa S. Bhate18f1682013-07-30 04:24:23 +05301209 cpufreq_init_policy(policy);
1210
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301211 if (!recover_policy) {
Viresh Kumar08fd8c1c2013-12-24 07:11:01 +05301212 policy->user_policy.policy = policy->policy;
1213 policy->user_policy.governor = policy->governor;
1214 }
Viresh Kumar4e97b632014-03-04 11:44:01 +08001215 up_write(&policy->rwsem);
Viresh Kumar08fd8c1c2013-12-24 07:11:01 +05301216
Greg Kroah-Hartman038c5b32007-12-17 15:54:39 -04001217 kobject_uevent(&policy->kobj, KOBJ_ADD);
Viresh Kumar6eed9402013-08-06 22:53:11 +05301218 up_read(&cpufreq_rwsem);
1219
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02001220 pr_debug("initialization complete\n");
Dave Jones87c32272006-03-29 01:48:37 -05001221
Linus Torvalds1da177e2005-04-16 15:20:36 -07001222 return 0;
1223
Linus Torvalds1da177e2005-04-16 15:20:36 -07001224err_out_unregister:
Viresh Kumar652ed952014-01-09 20:38:43 +05301225err_get_freq:
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00001226 write_lock_irqsave(&cpufreq_driver_lock, flags);
Viresh Kumar474deff2013-08-20 12:08:25 +05301227 for_each_cpu(j, policy->cpus)
Mike Travis7a6aedf2008-03-25 15:06:53 -07001228 per_cpu(cpufreq_cpu_data, j) = NULL;
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00001229 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001230
Viresh Kumarda60ce92013-10-03 20:28:30 +05301231 if (cpufreq_driver->exit)
1232 cpufreq_driver->exit(policy);
Viresh Kumar2eaa3e22013-02-07 10:55:00 +05301233err_set_policy_cpu:
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301234 if (recover_policy) {
Rafael J. Wysocki72368d12013-12-27 01:07:11 +01001235 /* Do not leave stale fallback data behind. */
1236 per_cpu(cpufreq_cpu_data_fallback, cpu) = NULL;
Viresh Kumar42f921a2013-12-20 21:26:02 +05301237 cpufreq_policy_put_kobj(policy);
Rafael J. Wysocki72368d12013-12-27 01:07:11 +01001238 }
Srivatsa S. Bhate9698cc2013-07-30 04:24:11 +05301239 cpufreq_policy_free(policy);
Viresh Kumar42f921a2013-12-20 21:26:02 +05301240
Linus Torvalds1da177e2005-04-16 15:20:36 -07001241nomem_out:
Viresh Kumar6eed9402013-08-06 22:53:11 +05301242 up_read(&cpufreq_rwsem);
1243
Linus Torvalds1da177e2005-04-16 15:20:36 -07001244 return ret;
1245}
1246
Srivatsa S. Bhata82fab22013-07-30 04:24:49 +05301247/**
1248 * cpufreq_add_dev - add a CPU device
1249 *
1250 * Adds the cpufreq interface for a CPU device.
1251 *
1252 * The Oracle says: try running cpufreq registration/unregistration concurrently
1253 * with with cpu hotplugging and all hell will break loose. Tried to clean this
1254 * mess up, but more thorough testing is needed. - Mathieu
1255 */
1256static int cpufreq_add_dev(struct device *dev, struct subsys_interface *sif)
1257{
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301258 return __cpufreq_add_dev(dev, sif);
Srivatsa S. Bhata82fab22013-07-30 04:24:49 +05301259}
1260
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301261static int cpufreq_nominate_new_policy_cpu(struct cpufreq_policy *policy,
Viresh Kumar42f921a2013-12-20 21:26:02 +05301262 unsigned int old_cpu)
Srivatsa S. Bhatf9ba6802013-07-30 04:24:36 +05301263{
1264 struct device *cpu_dev;
Srivatsa S. Bhatf9ba6802013-07-30 04:24:36 +05301265 int ret;
1266
1267 /* first sibling now owns the new sysfs dir */
Viresh Kumar9c8f1ee2013-09-12 17:06:33 +05301268 cpu_dev = get_cpu_device(cpumask_any_but(policy->cpus, old_cpu));
Srivatsa S. Bhata82fab22013-07-30 04:24:49 +05301269
Srivatsa S. Bhatf9ba6802013-07-30 04:24:36 +05301270 sysfs_remove_link(&cpu_dev->kobj, "cpufreq");
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301271 ret = kobject_move(&policy->kobj, &cpu_dev->kobj);
Srivatsa S. Bhatf9ba6802013-07-30 04:24:36 +05301272 if (ret) {
Joe Perchese837f9b2014-03-11 10:03:00 -07001273 pr_err("%s: Failed to move kobj: %d\n", __func__, ret);
Srivatsa S. Bhatf9ba6802013-07-30 04:24:36 +05301274
viresh kumarad7722d2013-10-18 19:10:15 +05301275 down_write(&policy->rwsem);
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301276 cpumask_set_cpu(old_cpu, policy->cpus);
viresh kumarad7722d2013-10-18 19:10:15 +05301277 up_write(&policy->rwsem);
Srivatsa S. Bhatf9ba6802013-07-30 04:24:36 +05301278
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301279 ret = sysfs_create_link(&cpu_dev->kobj, &policy->kobj,
Srivatsa S. Bhatf9ba6802013-07-30 04:24:36 +05301280 "cpufreq");
1281
1282 return -EINVAL;
1283 }
1284
1285 return cpu_dev->id;
1286}
1287
Srivatsa S. Bhatcedb70a2013-09-07 01:23:09 +05301288static int __cpufreq_remove_dev_prepare(struct device *dev,
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301289 struct subsys_interface *sif)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001290{
Srivatsa S. Bhatf9ba6802013-07-30 04:24:36 +05301291 unsigned int cpu = dev->id, cpus;
Viresh Kumar3de9bde2013-08-06 22:53:13 +05301292 int new_cpu, ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001293 unsigned long flags;
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301294 struct cpufreq_policy *policy;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001295
Viresh Kumarb8eed8a2013-01-14 13:23:03 +00001296 pr_debug("%s: unregistering CPU %u\n", __func__, cpu);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001297
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00001298 write_lock_irqsave(&cpufreq_driver_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001299
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301300 policy = per_cpu(cpufreq_cpu_data, cpu);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001301
Srivatsa S. Bhat84148092013-07-30 04:25:10 +05301302 /* Save the policy somewhere when doing a light-weight tear-down */
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301303 if (cpufreq_suspended)
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301304 per_cpu(cpufreq_cpu_data_fallback, cpu) = policy;
Srivatsa S. Bhat84148092013-07-30 04:25:10 +05301305
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00001306 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001307
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301308 if (!policy) {
Viresh Kumarb8eed8a2013-01-14 13:23:03 +00001309 pr_debug("%s: No cpu_data found\n", __func__);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001310 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001311 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001312
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +05301313 if (has_target()) {
Viresh Kumar3de9bde2013-08-06 22:53:13 +05301314 ret = __cpufreq_governor(policy, CPUFREQ_GOV_STOP);
1315 if (ret) {
1316 pr_err("%s: Failed to stop governor\n", __func__);
1317 return ret;
1318 }
1319 }
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08001320
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02001321 if (!cpufreq_driver->setpolicy)
Dirk Brandewiefa69e332013-02-06 09:02:11 -08001322 strncpy(per_cpu(cpufreq_cpu_governor, cpu),
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301323 policy->governor->name, CPUFREQ_NAME_LEN);
Jacob Shin27ecddc2011-04-27 13:32:11 -05001324
viresh kumarad7722d2013-10-18 19:10:15 +05301325 down_read(&policy->rwsem);
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301326 cpus = cpumask_weight(policy->cpus);
viresh kumarad7722d2013-10-18 19:10:15 +05301327 up_read(&policy->rwsem);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001328
Srivatsa S. Bhat61173f22013-09-12 01:43:25 +05301329 if (cpu != policy->cpu) {
viresh kumar6964d912014-02-17 14:52:11 +05301330 sysfs_remove_link(&dev->kobj, "cpufreq");
Viresh Kumar73bf0fc2013-02-05 22:21:14 +01001331 } else if (cpus > 1) {
Viresh Kumar42f921a2013-12-20 21:26:02 +05301332 new_cpu = cpufreq_nominate_new_policy_cpu(policy, cpu);
Srivatsa S. Bhatf9ba6802013-07-30 04:24:36 +05301333 if (new_cpu >= 0) {
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301334 update_policy_cpu(policy, new_cpu);
Srivatsa S. Bhata82fab22013-07-30 04:24:49 +05301335
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301336 if (!cpufreq_suspended) {
Viresh Kumar75949c92013-10-02 14:13:13 +05301337 pr_debug("%s: policy Kobject moved to cpu: %d from: %d\n",
Joe Perchese837f9b2014-03-11 10:03:00 -07001338 __func__, new_cpu, cpu);
Srivatsa S. Bhata82fab22013-07-30 04:24:49 +05301339 }
Viresh Kumarb8eed8a2013-01-14 13:23:03 +00001340 }
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08001341 }
Venki Pallipadiec282972007-03-26 12:03:19 -07001342
Srivatsa S. Bhatcedb70a2013-09-07 01:23:09 +05301343 return 0;
1344}
1345
1346static int __cpufreq_remove_dev_finish(struct device *dev,
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301347 struct subsys_interface *sif)
Srivatsa S. Bhatcedb70a2013-09-07 01:23:09 +05301348{
1349 unsigned int cpu = dev->id, cpus;
1350 int ret;
1351 unsigned long flags;
1352 struct cpufreq_policy *policy;
Srivatsa S. Bhatcedb70a2013-09-07 01:23:09 +05301353
1354 read_lock_irqsave(&cpufreq_driver_lock, flags);
1355 policy = per_cpu(cpufreq_cpu_data, cpu);
1356 read_unlock_irqrestore(&cpufreq_driver_lock, flags);
1357
1358 if (!policy) {
1359 pr_debug("%s: No cpu_data found\n", __func__);
1360 return -EINVAL;
1361 }
1362
viresh kumarad7722d2013-10-18 19:10:15 +05301363 down_write(&policy->rwsem);
Srivatsa S. Bhatcedb70a2013-09-07 01:23:09 +05301364 cpus = cpumask_weight(policy->cpus);
Viresh Kumar9c8f1ee2013-09-12 17:06:33 +05301365
1366 if (cpus > 1)
1367 cpumask_clear_cpu(cpu, policy->cpus);
viresh kumarad7722d2013-10-18 19:10:15 +05301368 up_write(&policy->rwsem);
Srivatsa S. Bhatcedb70a2013-09-07 01:23:09 +05301369
Viresh Kumarb8eed8a2013-01-14 13:23:03 +00001370 /* If cpu is last user of policy, free policy */
1371 if (cpus == 1) {
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +05301372 if (has_target()) {
Viresh Kumar3de9bde2013-08-06 22:53:13 +05301373 ret = __cpufreq_governor(policy,
1374 CPUFREQ_GOV_POLICY_EXIT);
1375 if (ret) {
1376 pr_err("%s: Failed to exit governor\n",
Joe Perchese837f9b2014-03-11 10:03:00 -07001377 __func__);
Viresh Kumar3de9bde2013-08-06 22:53:13 +05301378 return ret;
1379 }
Viresh Kumaredab2fb2013-08-20 12:08:22 +05301380 }
Rafael J. Wysocki2a998592013-07-30 00:32:00 +02001381
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301382 if (!cpufreq_suspended)
Viresh Kumar42f921a2013-12-20 21:26:02 +05301383 cpufreq_policy_put_kobj(policy);
Srivatsa S. Bhat84148092013-07-30 04:25:10 +05301384
1385 /*
1386 * Perform the ->exit() even during light-weight tear-down,
1387 * since this is a core component, and is essential for the
1388 * subsequent light-weight ->init() to succeed.
Viresh Kumarb8eed8a2013-01-14 13:23:03 +00001389 */
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02001390 if (cpufreq_driver->exit)
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301391 cpufreq_driver->exit(policy);
Viresh Kumarb8eed8a2013-01-14 13:23:03 +00001392
Viresh Kumar9515f4d2013-08-20 12:08:23 +05301393 /* Remove policy from list of active policies */
1394 write_lock_irqsave(&cpufreq_driver_lock, flags);
1395 list_del(&policy->policy_list);
1396 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
1397
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301398 if (!cpufreq_suspended)
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301399 cpufreq_policy_free(policy);
Stratos Karafotise5c87b72014-03-19 23:29:17 +02001400 } else if (has_target()) {
1401 ret = __cpufreq_governor(policy, CPUFREQ_GOV_START);
1402 if (!ret)
1403 ret = __cpufreq_governor(policy, CPUFREQ_GOV_LIMITS);
1404
1405 if (ret) {
1406 pr_err("%s: Failed to start governor\n", __func__);
1407 return ret;
Rafael J. Wysocki2a998592013-07-30 00:32:00 +02001408 }
Viresh Kumarb8eed8a2013-01-14 13:23:03 +00001409 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001410
Viresh Kumar474deff2013-08-20 12:08:25 +05301411 per_cpu(cpufreq_cpu_data, cpu) = NULL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001412 return 0;
1413}
1414
Srivatsa S. Bhatcedb70a2013-09-07 01:23:09 +05301415/**
Viresh Kumar27a862e2013-10-02 14:13:14 +05301416 * cpufreq_remove_dev - remove a CPU device
Srivatsa S. Bhatcedb70a2013-09-07 01:23:09 +05301417 *
1418 * Removes the cpufreq interface for a CPU device.
Srivatsa S. Bhatcedb70a2013-09-07 01:23:09 +05301419 */
Kay Sievers8a25a2f2011-12-21 14:29:42 -08001420static int cpufreq_remove_dev(struct device *dev, struct subsys_interface *sif)
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08001421{
Kay Sievers8a25a2f2011-12-21 14:29:42 -08001422 unsigned int cpu = dev->id;
Viresh Kumar27a862e2013-10-02 14:13:14 +05301423 int ret;
Venki Pallipadiec282972007-03-26 12:03:19 -07001424
1425 if (cpu_is_offline(cpu))
1426 return 0;
1427
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301428 ret = __cpufreq_remove_dev_prepare(dev, sif);
Viresh Kumar27a862e2013-10-02 14:13:14 +05301429
1430 if (!ret)
Viresh Kumar96bbbe42014-03-10 14:53:35 +05301431 ret = __cpufreq_remove_dev_finish(dev, sif);
Viresh Kumar27a862e2013-10-02 14:13:14 +05301432
1433 return ret;
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08001434}
1435
David Howells65f27f32006-11-22 14:55:48 +00001436static void handle_update(struct work_struct *work)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001437{
David Howells65f27f32006-11-22 14:55:48 +00001438 struct cpufreq_policy *policy =
1439 container_of(work, struct cpufreq_policy, update);
1440 unsigned int cpu = policy->cpu;
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02001441 pr_debug("handle_update for cpu %u called\n", cpu);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001442 cpufreq_update_policy(cpu);
1443}
1444
1445/**
Viresh Kumarbb176f72013-06-19 14:19:33 +05301446 * cpufreq_out_of_sync - If actual and saved CPU frequency differs, we're
1447 * in deep trouble.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001448 * @cpu: cpu number
1449 * @old_freq: CPU frequency the kernel thinks the CPU runs at
1450 * @new_freq: CPU frequency the CPU actually runs at
1451 *
Dave Jones29464f22009-01-18 01:37:11 -05001452 * We adjust to current frequency first, and need to clean up later.
1453 * So either call to cpufreq_update_policy() or schedule handle_update()).
Linus Torvalds1da177e2005-04-16 15:20:36 -07001454 */
Gautham R Shenoye08f5f52006-10-26 16:20:58 +05301455static void cpufreq_out_of_sync(unsigned int cpu, unsigned int old_freq,
1456 unsigned int new_freq)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001457{
Viresh Kumarb43a7ff2013-03-24 11:56:43 +05301458 struct cpufreq_policy *policy;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001459 struct cpufreq_freqs freqs;
Viresh Kumarb43a7ff2013-03-24 11:56:43 +05301460 unsigned long flags;
1461
Joe Perchese837f9b2014-03-11 10:03:00 -07001462 pr_debug("Warning: CPU frequency out of sync: cpufreq and timing core thinks of %u, is %u kHz\n",
1463 old_freq, new_freq);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001464
Linus Torvalds1da177e2005-04-16 15:20:36 -07001465 freqs.old = old_freq;
1466 freqs.new = new_freq;
Viresh Kumarb43a7ff2013-03-24 11:56:43 +05301467
1468 read_lock_irqsave(&cpufreq_driver_lock, flags);
1469 policy = per_cpu(cpufreq_cpu_data, cpu);
1470 read_unlock_irqrestore(&cpufreq_driver_lock, flags);
1471
1472 cpufreq_notify_transition(policy, &freqs, CPUFREQ_PRECHANGE);
1473 cpufreq_notify_transition(policy, &freqs, CPUFREQ_POSTCHANGE);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001474}
1475
Dave Jones32ee8c32006-02-28 00:43:23 -05001476/**
Dhaval Giani4ab70df2006-12-13 14:49:15 +05301477 * cpufreq_quick_get - get the CPU frequency (in kHz) from policy->cur
Venkatesh Pallipadi95235ca2005-12-02 10:43:20 -08001478 * @cpu: CPU number
1479 *
1480 * This is the last known freq, without actually getting it from the driver.
1481 * Return value will be same as what is shown in scaling_cur_freq in sysfs.
1482 */
1483unsigned int cpufreq_quick_get(unsigned int cpu)
1484{
Dirk Brandewie9e21ba82013-02-06 09:02:08 -08001485 struct cpufreq_policy *policy;
Gautham R Shenoye08f5f52006-10-26 16:20:58 +05301486 unsigned int ret_freq = 0;
Venkatesh Pallipadi95235ca2005-12-02 10:43:20 -08001487
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02001488 if (cpufreq_driver && cpufreq_driver->setpolicy && cpufreq_driver->get)
1489 return cpufreq_driver->get(cpu);
Dirk Brandewie9e21ba82013-02-06 09:02:08 -08001490
1491 policy = cpufreq_cpu_get(cpu);
Venkatesh Pallipadi95235ca2005-12-02 10:43:20 -08001492 if (policy) {
Gautham R Shenoye08f5f52006-10-26 16:20:58 +05301493 ret_freq = policy->cur;
Venkatesh Pallipadi95235ca2005-12-02 10:43:20 -08001494 cpufreq_cpu_put(policy);
1495 }
1496
Dave Jones4d34a672008-02-07 16:33:49 -05001497 return ret_freq;
Venkatesh Pallipadi95235ca2005-12-02 10:43:20 -08001498}
1499EXPORT_SYMBOL(cpufreq_quick_get);
1500
Jesse Barnes3d737102011-06-28 10:59:12 -07001501/**
1502 * cpufreq_quick_get_max - get the max reported CPU frequency for this CPU
1503 * @cpu: CPU number
1504 *
1505 * Just return the max possible frequency for a given CPU.
1506 */
1507unsigned int cpufreq_quick_get_max(unsigned int cpu)
1508{
1509 struct cpufreq_policy *policy = cpufreq_cpu_get(cpu);
1510 unsigned int ret_freq = 0;
1511
1512 if (policy) {
1513 ret_freq = policy->max;
1514 cpufreq_cpu_put(policy);
1515 }
1516
1517 return ret_freq;
1518}
1519EXPORT_SYMBOL(cpufreq_quick_get_max);
1520
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08001521static unsigned int __cpufreq_get(unsigned int cpu)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001522{
Mike Travis7a6aedf2008-03-25 15:06:53 -07001523 struct cpufreq_policy *policy = per_cpu(cpufreq_cpu_data, cpu);
Gautham R Shenoye08f5f52006-10-26 16:20:58 +05301524 unsigned int ret_freq = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001525
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02001526 if (!cpufreq_driver->get)
Dave Jones4d34a672008-02-07 16:33:49 -05001527 return ret_freq;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001528
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02001529 ret_freq = cpufreq_driver->get(cpu);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001530
Gautham R Shenoye08f5f52006-10-26 16:20:58 +05301531 if (ret_freq && policy->cur &&
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02001532 !(cpufreq_driver->flags & CPUFREQ_CONST_LOOPS)) {
Gautham R Shenoye08f5f52006-10-26 16:20:58 +05301533 /* verify no discrepancy between actual and
1534 saved value exists */
1535 if (unlikely(ret_freq != policy->cur)) {
1536 cpufreq_out_of_sync(cpu, policy->cur, ret_freq);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001537 schedule_work(&policy->update);
1538 }
1539 }
1540
Dave Jones4d34a672008-02-07 16:33:49 -05001541 return ret_freq;
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08001542}
Linus Torvalds1da177e2005-04-16 15:20:36 -07001543
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08001544/**
1545 * cpufreq_get - get the current CPU frequency (in kHz)
1546 * @cpu: CPU number
1547 *
1548 * Get the CPU current (static) CPU frequency
1549 */
1550unsigned int cpufreq_get(unsigned int cpu)
1551{
Aaron Plattner999976e2014-03-04 12:42:15 -08001552 struct cpufreq_policy *policy = cpufreq_cpu_get(cpu);
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08001553 unsigned int ret_freq = 0;
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08001554
Aaron Plattner999976e2014-03-04 12:42:15 -08001555 if (policy) {
1556 down_read(&policy->rwsem);
1557 ret_freq = __cpufreq_get(cpu);
1558 up_read(&policy->rwsem);
Viresh Kumar26ca86942013-09-20 22:37:31 +05301559
Aaron Plattner999976e2014-03-04 12:42:15 -08001560 cpufreq_cpu_put(policy);
1561 }
Viresh Kumar6eed9402013-08-06 22:53:11 +05301562
Dave Jones4d34a672008-02-07 16:33:49 -05001563 return ret_freq;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001564}
1565EXPORT_SYMBOL(cpufreq_get);
1566
Kay Sievers8a25a2f2011-12-21 14:29:42 -08001567static struct subsys_interface cpufreq_interface = {
1568 .name = "cpufreq",
1569 .subsys = &cpu_subsys,
1570 .add_dev = cpufreq_add_dev,
1571 .remove_dev = cpufreq_remove_dev,
Rafael J. Wysockie00e56d2011-03-23 22:16:32 +01001572};
1573
Viresh Kumare28867e2014-03-04 11:00:27 +08001574/*
1575 * In case platform wants some specific frequency to be configured
1576 * during suspend..
Benjamin Herrenschmidt42d4dc32005-04-29 07:40:12 -07001577 */
Viresh Kumare28867e2014-03-04 11:00:27 +08001578int cpufreq_generic_suspend(struct cpufreq_policy *policy)
Benjamin Herrenschmidt42d4dc32005-04-29 07:40:12 -07001579{
Viresh Kumare28867e2014-03-04 11:00:27 +08001580 int ret;
Dave Jones4bc5d342009-08-04 14:03:25 -04001581
Viresh Kumare28867e2014-03-04 11:00:27 +08001582 if (!policy->suspend_freq) {
1583 pr_err("%s: suspend_freq can't be zero\n", __func__);
1584 return -EINVAL;
Benjamin Herrenschmidt42d4dc32005-04-29 07:40:12 -07001585 }
1586
Viresh Kumare28867e2014-03-04 11:00:27 +08001587 pr_debug("%s: Setting suspend-freq: %u\n", __func__,
1588 policy->suspend_freq);
1589
1590 ret = __cpufreq_driver_target(policy, policy->suspend_freq,
1591 CPUFREQ_RELATION_H);
1592 if (ret)
1593 pr_err("%s: unable to set suspend-freq: %u. err: %d\n",
1594 __func__, policy->suspend_freq, ret);
1595
Dave Jonesc9060492008-02-07 16:32:18 -05001596 return ret;
Benjamin Herrenschmidt42d4dc32005-04-29 07:40:12 -07001597}
Viresh Kumare28867e2014-03-04 11:00:27 +08001598EXPORT_SYMBOL(cpufreq_generic_suspend);
Benjamin Herrenschmidt42d4dc32005-04-29 07:40:12 -07001599
1600/**
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001601 * cpufreq_suspend() - Suspend CPUFreq governors
Linus Torvalds1da177e2005-04-16 15:20:36 -07001602 *
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001603 * Called during system wide Suspend/Hibernate cycles for suspending governors
1604 * as some platforms can't change frequency after this point in suspend cycle.
1605 * Because some of the devices (like: i2c, regulators, etc) they use for
1606 * changing frequency are suspended quickly after this point.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001607 */
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001608void cpufreq_suspend(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001609{
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05301610 struct cpufreq_policy *policy;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001611
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001612 if (!cpufreq_driver)
Rafael J. Wysockie00e56d2011-03-23 22:16:32 +01001613 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001614
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001615 if (!has_target())
1616 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001617
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001618 pr_debug("%s: Suspending Governors\n", __func__);
1619
1620 list_for_each_entry(policy, &cpufreq_policy_list, policy_list) {
1621 if (__cpufreq_governor(policy, CPUFREQ_GOV_STOP))
1622 pr_err("%s: Failed to stop governor for policy: %p\n",
1623 __func__, policy);
1624 else if (cpufreq_driver->suspend
1625 && cpufreq_driver->suspend(policy))
1626 pr_err("%s: Failed to suspend driver: %p\n", __func__,
1627 policy);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001628 }
1629
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001630 cpufreq_suspended = true;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001631}
1632
Linus Torvalds1da177e2005-04-16 15:20:36 -07001633/**
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001634 * cpufreq_resume() - Resume CPUFreq governors
Linus Torvalds1da177e2005-04-16 15:20:36 -07001635 *
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001636 * Called during system wide Suspend/Hibernate cycle for resuming governors that
1637 * are suspended with cpufreq_suspend().
Linus Torvalds1da177e2005-04-16 15:20:36 -07001638 */
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001639void cpufreq_resume(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001640{
Linus Torvalds1da177e2005-04-16 15:20:36 -07001641 struct cpufreq_policy *policy;
1642
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001643 if (!cpufreq_driver)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001644 return;
1645
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001646 if (!has_target())
1647 return;
1648
1649 pr_debug("%s: Resuming Governors\n", __func__);
1650
1651 cpufreq_suspended = false;
1652
1653 list_for_each_entry(policy, &cpufreq_policy_list, policy_list) {
1654 if (__cpufreq_governor(policy, CPUFREQ_GOV_START)
1655 || __cpufreq_governor(policy, CPUFREQ_GOV_LIMITS))
1656 pr_err("%s: Failed to start governor for policy: %p\n",
1657 __func__, policy);
1658 else if (cpufreq_driver->resume
1659 && cpufreq_driver->resume(policy))
1660 pr_err("%s: Failed to resume driver: %p\n", __func__,
1661 policy);
1662
1663 /*
1664 * schedule call cpufreq_update_policy() for boot CPU, i.e. last
1665 * policy in list. It will verify that the current freq is in
1666 * sync with what we believe it to be.
1667 */
1668 if (list_is_last(&policy->policy_list, &cpufreq_policy_list))
1669 schedule_work(&policy->update);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001670 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001671}
Linus Torvalds1da177e2005-04-16 15:20:36 -07001672
Borislav Petkov9d950462013-01-20 10:24:28 +00001673/**
1674 * cpufreq_get_current_driver - return current driver's name
1675 *
1676 * Return the name string of the currently loaded cpufreq driver
1677 * or NULL, if none.
1678 */
1679const char *cpufreq_get_current_driver(void)
1680{
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02001681 if (cpufreq_driver)
1682 return cpufreq_driver->name;
1683
1684 return NULL;
Borislav Petkov9d950462013-01-20 10:24:28 +00001685}
1686EXPORT_SYMBOL_GPL(cpufreq_get_current_driver);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001687
1688/*********************************************************************
1689 * NOTIFIER LISTS INTERFACE *
1690 *********************************************************************/
1691
1692/**
1693 * cpufreq_register_notifier - register a driver with cpufreq
1694 * @nb: notifier function to register
1695 * @list: CPUFREQ_TRANSITION_NOTIFIER or CPUFREQ_POLICY_NOTIFIER
1696 *
Dave Jones32ee8c32006-02-28 00:43:23 -05001697 * Add a driver to one of two lists: either a list of drivers that
Linus Torvalds1da177e2005-04-16 15:20:36 -07001698 * are notified about clock rate changes (once before and once after
1699 * the transition), or a list of drivers that are notified about
1700 * changes in cpufreq policy.
1701 *
1702 * This function may sleep, and has the same return conditions as
Alan Sterne041c682006-03-27 01:16:30 -08001703 * blocking_notifier_chain_register.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001704 */
1705int cpufreq_register_notifier(struct notifier_block *nb, unsigned int list)
1706{
1707 int ret;
1708
Dirk Brandewied5aaffa2013-01-17 16:22:21 +00001709 if (cpufreq_disabled())
1710 return -EINVAL;
1711
Cesar Eduardo Barros74212ca2008-02-16 08:41:24 -02001712 WARN_ON(!init_cpufreq_transition_notifier_list_called);
1713
Linus Torvalds1da177e2005-04-16 15:20:36 -07001714 switch (list) {
1715 case CPUFREQ_TRANSITION_NOTIFIER:
Alan Sternb4dfdbb2006-10-04 02:17:06 -07001716 ret = srcu_notifier_chain_register(
Alan Sterne041c682006-03-27 01:16:30 -08001717 &cpufreq_transition_notifier_list, nb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001718 break;
1719 case CPUFREQ_POLICY_NOTIFIER:
Alan Sterne041c682006-03-27 01:16:30 -08001720 ret = blocking_notifier_chain_register(
1721 &cpufreq_policy_notifier_list, nb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001722 break;
1723 default:
1724 ret = -EINVAL;
1725 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001726
1727 return ret;
1728}
1729EXPORT_SYMBOL(cpufreq_register_notifier);
1730
Linus Torvalds1da177e2005-04-16 15:20:36 -07001731/**
1732 * cpufreq_unregister_notifier - unregister a driver with cpufreq
1733 * @nb: notifier block to be unregistered
Viresh Kumarbb176f72013-06-19 14:19:33 +05301734 * @list: CPUFREQ_TRANSITION_NOTIFIER or CPUFREQ_POLICY_NOTIFIER
Linus Torvalds1da177e2005-04-16 15:20:36 -07001735 *
1736 * Remove a driver from the CPU frequency notifier list.
1737 *
1738 * This function may sleep, and has the same return conditions as
Alan Sterne041c682006-03-27 01:16:30 -08001739 * blocking_notifier_chain_unregister.
Linus Torvalds1da177e2005-04-16 15:20:36 -07001740 */
1741int cpufreq_unregister_notifier(struct notifier_block *nb, unsigned int list)
1742{
1743 int ret;
1744
Dirk Brandewied5aaffa2013-01-17 16:22:21 +00001745 if (cpufreq_disabled())
1746 return -EINVAL;
1747
Linus Torvalds1da177e2005-04-16 15:20:36 -07001748 switch (list) {
1749 case CPUFREQ_TRANSITION_NOTIFIER:
Alan Sternb4dfdbb2006-10-04 02:17:06 -07001750 ret = srcu_notifier_chain_unregister(
Alan Sterne041c682006-03-27 01:16:30 -08001751 &cpufreq_transition_notifier_list, nb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001752 break;
1753 case CPUFREQ_POLICY_NOTIFIER:
Alan Sterne041c682006-03-27 01:16:30 -08001754 ret = blocking_notifier_chain_unregister(
1755 &cpufreq_policy_notifier_list, nb);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001756 break;
1757 default:
1758 ret = -EINVAL;
1759 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001760
1761 return ret;
1762}
1763EXPORT_SYMBOL(cpufreq_unregister_notifier);
1764
1765
1766/*********************************************************************
1767 * GOVERNORS *
1768 *********************************************************************/
1769
Linus Torvalds1da177e2005-04-16 15:20:36 -07001770int __cpufreq_driver_target(struct cpufreq_policy *policy,
1771 unsigned int target_freq,
1772 unsigned int relation)
1773{
1774 int retval = -EINVAL;
Viresh Kumar72499242012-10-31 01:28:21 +01001775 unsigned int old_target_freq = target_freq;
Ashok Rajc32b6b82005-10-30 14:59:54 -08001776
Konrad Rzeszutek Wilka7b422c2012-03-13 19:18:39 -04001777 if (cpufreq_disabled())
1778 return -ENODEV;
1779
Viresh Kumar72499242012-10-31 01:28:21 +01001780 /* Make sure that target_freq is within supported range */
1781 if (target_freq > policy->max)
1782 target_freq = policy->max;
1783 if (target_freq < policy->min)
1784 target_freq = policy->min;
1785
1786 pr_debug("target for CPU %u: %u kHz, relation %u, requested %u kHz\n",
Joe Perchese837f9b2014-03-11 10:03:00 -07001787 policy->cpu, target_freq, relation, old_target_freq);
Viresh Kumar5a1c0222012-10-31 01:28:15 +01001788
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +05301789 /*
1790 * This might look like a redundant call as we are checking it again
1791 * after finding index. But it is left intentionally for cases where
1792 * exactly same freq is called again and so we can save on few function
1793 * calls.
1794 */
Viresh Kumar5a1c0222012-10-31 01:28:15 +01001795 if (target_freq == policy->cur)
1796 return 0;
1797
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02001798 if (cpufreq_driver->target)
1799 retval = cpufreq_driver->target(policy, target_freq, relation);
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +05301800 else if (cpufreq_driver->target_index) {
1801 struct cpufreq_frequency_table *freq_table;
Viresh Kumard4019f02013-08-14 19:38:24 +05301802 struct cpufreq_freqs freqs;
1803 bool notify;
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +05301804 int index;
Ashok Raj90d45d12005-11-08 21:34:24 -08001805
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +05301806 freq_table = cpufreq_frequency_get_table(policy->cpu);
1807 if (unlikely(!freq_table)) {
1808 pr_err("%s: Unable to find freq_table\n", __func__);
1809 goto out;
1810 }
1811
1812 retval = cpufreq_frequency_table_target(policy, freq_table,
1813 target_freq, relation, &index);
1814 if (unlikely(retval)) {
1815 pr_err("%s: Unable to find matching freq\n", __func__);
1816 goto out;
1817 }
1818
Viresh Kumard4019f02013-08-14 19:38:24 +05301819 if (freq_table[index].frequency == policy->cur) {
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +05301820 retval = 0;
Viresh Kumard4019f02013-08-14 19:38:24 +05301821 goto out;
1822 }
1823
1824 notify = !(cpufreq_driver->flags & CPUFREQ_ASYNC_NOTIFICATION);
1825
1826 if (notify) {
1827 freqs.old = policy->cur;
1828 freqs.new = freq_table[index].frequency;
1829 freqs.flags = 0;
1830
1831 pr_debug("%s: cpu: %d, oldfreq: %u, new freq: %u\n",
Joe Perchese837f9b2014-03-11 10:03:00 -07001832 __func__, policy->cpu, freqs.old, freqs.new);
Viresh Kumard4019f02013-08-14 19:38:24 +05301833
1834 cpufreq_notify_transition(policy, &freqs,
1835 CPUFREQ_PRECHANGE);
1836 }
1837
1838 retval = cpufreq_driver->target_index(policy, index);
1839 if (retval)
1840 pr_err("%s: Failed to change cpu frequency: %d\n",
Joe Perchese837f9b2014-03-11 10:03:00 -07001841 __func__, retval);
Viresh Kumard4019f02013-08-14 19:38:24 +05301842
Viresh Kumarab1b1c42013-12-02 11:04:13 +05301843 if (notify)
1844 cpufreq_notify_post_transition(policy, &freqs, retval);
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +05301845 }
1846
1847out:
Linus Torvalds1da177e2005-04-16 15:20:36 -07001848 return retval;
1849}
1850EXPORT_SYMBOL_GPL(__cpufreq_driver_target);
1851
Linus Torvalds1da177e2005-04-16 15:20:36 -07001852int cpufreq_driver_target(struct cpufreq_policy *policy,
1853 unsigned int target_freq,
1854 unsigned int relation)
1855{
Julia Lawallf1829e42008-07-25 22:44:53 +02001856 int ret = -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001857
viresh kumarad7722d2013-10-18 19:10:15 +05301858 down_write(&policy->rwsem);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001859
1860 ret = __cpufreq_driver_target(policy, target_freq, relation);
1861
viresh kumarad7722d2013-10-18 19:10:15 +05301862 up_write(&policy->rwsem);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001863
Linus Torvalds1da177e2005-04-16 15:20:36 -07001864 return ret;
1865}
1866EXPORT_SYMBOL_GPL(cpufreq_driver_target);
1867
Arjan van de Ven153d7f32006-07-26 15:40:07 +02001868/*
Arjan van de Ven153d7f32006-07-26 15:40:07 +02001869 * when "event" is CPUFREQ_GOV_LIMITS
1870 */
Linus Torvalds1da177e2005-04-16 15:20:36 -07001871
Gautham R Shenoye08f5f52006-10-26 16:20:58 +05301872static int __cpufreq_governor(struct cpufreq_policy *policy,
1873 unsigned int event)
Linus Torvalds1da177e2005-04-16 15:20:36 -07001874{
Dave Jonescc993ca2005-07-28 09:43:56 -07001875 int ret;
Thomas Renninger6afde102007-10-02 13:28:13 -07001876
1877 /* Only must be defined when default governor is known to have latency
1878 restrictions, like e.g. conservative or ondemand.
1879 That this is the case is already ensured in Kconfig
1880 */
1881#ifdef CONFIG_CPU_FREQ_GOV_PERFORMANCE
1882 struct cpufreq_governor *gov = &cpufreq_gov_performance;
1883#else
1884 struct cpufreq_governor *gov = NULL;
1885#endif
Thomas Renninger1c256242007-10-02 13:28:12 -07001886
Viresh Kumar2f0aea92014-03-04 11:00:26 +08001887 /* Don't start any governor operations if we are entering suspend */
1888 if (cpufreq_suspended)
1889 return 0;
1890
Thomas Renninger1c256242007-10-02 13:28:12 -07001891 if (policy->governor->max_transition_latency &&
1892 policy->cpuinfo.transition_latency >
1893 policy->governor->max_transition_latency) {
Thomas Renninger6afde102007-10-02 13:28:13 -07001894 if (!gov)
1895 return -EINVAL;
1896 else {
Joe Perchese837f9b2014-03-11 10:03:00 -07001897 pr_warn("%s governor failed, too long transition latency of HW, fallback to %s governor\n",
1898 policy->governor->name, gov->name);
Thomas Renninger6afde102007-10-02 13:28:13 -07001899 policy->governor = gov;
1900 }
Thomas Renninger1c256242007-10-02 13:28:12 -07001901 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001902
Viresh Kumarfe492f32013-08-06 22:53:10 +05301903 if (event == CPUFREQ_GOV_POLICY_INIT)
1904 if (!try_module_get(policy->governor->owner))
1905 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001906
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02001907 pr_debug("__cpufreq_governor for CPU %u, event %u\n",
Joe Perchese837f9b2014-03-11 10:03:00 -07001908 policy->cpu, event);
Xiaoguang Chen95731eb2013-06-19 15:00:07 +08001909
1910 mutex_lock(&cpufreq_governor_lock);
Srivatsa S. Bhat56d07db2013-09-07 01:23:55 +05301911 if ((policy->governor_enabled && event == CPUFREQ_GOV_START)
Viresh Kumarf73d3932013-08-31 17:53:40 +05301912 || (!policy->governor_enabled
1913 && (event == CPUFREQ_GOV_LIMITS || event == CPUFREQ_GOV_STOP))) {
Xiaoguang Chen95731eb2013-06-19 15:00:07 +08001914 mutex_unlock(&cpufreq_governor_lock);
1915 return -EBUSY;
1916 }
1917
1918 if (event == CPUFREQ_GOV_STOP)
1919 policy->governor_enabled = false;
1920 else if (event == CPUFREQ_GOV_START)
1921 policy->governor_enabled = true;
1922
1923 mutex_unlock(&cpufreq_governor_lock);
1924
Linus Torvalds1da177e2005-04-16 15:20:36 -07001925 ret = policy->governor->governor(policy, event);
1926
Viresh Kumar4d5dcc42013-03-27 15:58:58 +00001927 if (!ret) {
1928 if (event == CPUFREQ_GOV_POLICY_INIT)
1929 policy->governor->initialized++;
1930 else if (event == CPUFREQ_GOV_POLICY_EXIT)
1931 policy->governor->initialized--;
Xiaoguang Chen95731eb2013-06-19 15:00:07 +08001932 } else {
1933 /* Restore original values */
1934 mutex_lock(&cpufreq_governor_lock);
1935 if (event == CPUFREQ_GOV_STOP)
1936 policy->governor_enabled = true;
1937 else if (event == CPUFREQ_GOV_START)
1938 policy->governor_enabled = false;
1939 mutex_unlock(&cpufreq_governor_lock);
Viresh Kumar4d5dcc42013-03-27 15:58:58 +00001940 }
Viresh Kumarb3940582013-02-01 05:42:58 +00001941
Viresh Kumarfe492f32013-08-06 22:53:10 +05301942 if (((event == CPUFREQ_GOV_POLICY_INIT) && ret) ||
1943 ((event == CPUFREQ_GOV_POLICY_EXIT) && !ret))
Linus Torvalds1da177e2005-04-16 15:20:36 -07001944 module_put(policy->governor->owner);
1945
1946 return ret;
1947}
1948
Linus Torvalds1da177e2005-04-16 15:20:36 -07001949int cpufreq_register_governor(struct cpufreq_governor *governor)
1950{
Jeremy Fitzhardinge3bcb09a2006-07-06 12:30:26 -07001951 int err;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001952
1953 if (!governor)
1954 return -EINVAL;
1955
Konrad Rzeszutek Wilka7b422c2012-03-13 19:18:39 -04001956 if (cpufreq_disabled())
1957 return -ENODEV;
1958
akpm@osdl.org3fc54d32006-01-13 15:54:22 -08001959 mutex_lock(&cpufreq_governor_mutex);
Dave Jones32ee8c32006-02-28 00:43:23 -05001960
Viresh Kumarb3940582013-02-01 05:42:58 +00001961 governor->initialized = 0;
Jeremy Fitzhardinge3bcb09a2006-07-06 12:30:26 -07001962 err = -EBUSY;
1963 if (__find_governor(governor->name) == NULL) {
1964 err = 0;
1965 list_add(&governor->governor_list, &cpufreq_governor_list);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001966 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07001967
Dave Jones32ee8c32006-02-28 00:43:23 -05001968 mutex_unlock(&cpufreq_governor_mutex);
Jeremy Fitzhardinge3bcb09a2006-07-06 12:30:26 -07001969 return err;
Linus Torvalds1da177e2005-04-16 15:20:36 -07001970}
1971EXPORT_SYMBOL_GPL(cpufreq_register_governor);
1972
Linus Torvalds1da177e2005-04-16 15:20:36 -07001973void cpufreq_unregister_governor(struct cpufreq_governor *governor)
1974{
Prarit Bhargava90e41ba2009-11-12 09:18:46 -05001975 int cpu;
Prarit Bhargava90e41ba2009-11-12 09:18:46 -05001976
Linus Torvalds1da177e2005-04-16 15:20:36 -07001977 if (!governor)
1978 return;
1979
Konrad Rzeszutek Wilka7b422c2012-03-13 19:18:39 -04001980 if (cpufreq_disabled())
1981 return;
1982
Prarit Bhargava90e41ba2009-11-12 09:18:46 -05001983 for_each_present_cpu(cpu) {
1984 if (cpu_online(cpu))
1985 continue;
1986 if (!strcmp(per_cpu(cpufreq_cpu_governor, cpu), governor->name))
1987 strcpy(per_cpu(cpufreq_cpu_governor, cpu), "\0");
1988 }
Prarit Bhargava90e41ba2009-11-12 09:18:46 -05001989
akpm@osdl.org3fc54d32006-01-13 15:54:22 -08001990 mutex_lock(&cpufreq_governor_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001991 list_del(&governor->governor_list);
akpm@osdl.org3fc54d32006-01-13 15:54:22 -08001992 mutex_unlock(&cpufreq_governor_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -07001993 return;
1994}
1995EXPORT_SYMBOL_GPL(cpufreq_unregister_governor);
1996
1997
Linus Torvalds1da177e2005-04-16 15:20:36 -07001998/*********************************************************************
1999 * POLICY INTERFACE *
2000 *********************************************************************/
2001
2002/**
2003 * cpufreq_get_policy - get the current cpufreq_policy
Dave Jones29464f22009-01-18 01:37:11 -05002004 * @policy: struct cpufreq_policy into which the current cpufreq_policy
2005 * is written
Linus Torvalds1da177e2005-04-16 15:20:36 -07002006 *
2007 * Reads the current cpufreq policy.
2008 */
2009int cpufreq_get_policy(struct cpufreq_policy *policy, unsigned int cpu)
2010{
2011 struct cpufreq_policy *cpu_policy;
2012 if (!policy)
2013 return -EINVAL;
2014
2015 cpu_policy = cpufreq_cpu_get(cpu);
2016 if (!cpu_policy)
2017 return -EINVAL;
2018
Viresh Kumard5b73cd2013-08-06 22:53:06 +05302019 memcpy(policy, cpu_policy, sizeof(*policy));
Linus Torvalds1da177e2005-04-16 15:20:36 -07002020
2021 cpufreq_cpu_put(cpu_policy);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002022 return 0;
2023}
2024EXPORT_SYMBOL(cpufreq_get_policy);
2025
Arjan van de Ven153d7f32006-07-26 15:40:07 +02002026/*
Viresh Kumar037ce832013-10-02 14:13:16 +05302027 * policy : current policy.
2028 * new_policy: policy to be set.
Arjan van de Ven153d7f32006-07-26 15:40:07 +02002029 */
Viresh Kumar037ce832013-10-02 14:13:16 +05302030static int cpufreq_set_policy(struct cpufreq_policy *policy,
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302031 struct cpufreq_policy *new_policy)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002032{
Rafael J. Wysockid9a789c2014-02-17 22:56:35 +01002033 struct cpufreq_governor *old_gov;
2034 int ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002035
Joe Perchese837f9b2014-03-11 10:03:00 -07002036 pr_debug("setting new policy for CPU %u: %u - %u kHz\n",
2037 new_policy->cpu, new_policy->min, new_policy->max);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002038
Viresh Kumard5b73cd2013-08-06 22:53:06 +05302039 memcpy(&new_policy->cpuinfo, &policy->cpuinfo, sizeof(policy->cpuinfo));
Linus Torvalds1da177e2005-04-16 15:20:36 -07002040
Rafael J. Wysockid9a789c2014-02-17 22:56:35 +01002041 if (new_policy->min > policy->max || new_policy->max < policy->min)
2042 return -EINVAL;
Mattia Dongili9c9a43e2006-07-05 23:12:20 +02002043
Linus Torvalds1da177e2005-04-16 15:20:36 -07002044 /* verify the cpu speed can be set within this limit */
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302045 ret = cpufreq_driver->verify(new_policy);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002046 if (ret)
Rafael J. Wysockid9a789c2014-02-17 22:56:35 +01002047 return ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002048
Linus Torvalds1da177e2005-04-16 15:20:36 -07002049 /* adjust if necessary - all reasons */
Alan Sterne041c682006-03-27 01:16:30 -08002050 blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302051 CPUFREQ_ADJUST, new_policy);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002052
2053 /* adjust if necessary - hardware incompatibility*/
Alan Sterne041c682006-03-27 01:16:30 -08002054 blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302055 CPUFREQ_INCOMPATIBLE, new_policy);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002056
Viresh Kumarbb176f72013-06-19 14:19:33 +05302057 /*
2058 * verify the cpu speed can be set within this limit, which might be
2059 * different to the first one
2060 */
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302061 ret = cpufreq_driver->verify(new_policy);
Alan Sterne041c682006-03-27 01:16:30 -08002062 if (ret)
Rafael J. Wysockid9a789c2014-02-17 22:56:35 +01002063 return ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002064
2065 /* notification of the new policy */
Alan Sterne041c682006-03-27 01:16:30 -08002066 blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302067 CPUFREQ_NOTIFY, new_policy);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002068
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302069 policy->min = new_policy->min;
2070 policy->max = new_policy->max;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002071
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02002072 pr_debug("new min and max freqs are %u - %u kHz\n",
Joe Perchese837f9b2014-03-11 10:03:00 -07002073 policy->min, policy->max);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002074
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02002075 if (cpufreq_driver->setpolicy) {
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302076 policy->policy = new_policy->policy;
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02002077 pr_debug("setting range\n");
Rafael J. Wysockid9a789c2014-02-17 22:56:35 +01002078 return cpufreq_driver->setpolicy(new_policy);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002079 }
2080
Rafael J. Wysockid9a789c2014-02-17 22:56:35 +01002081 if (new_policy->governor == policy->governor)
2082 goto out;
2083
2084 pr_debug("governor switch\n");
2085
2086 /* save old, working values */
2087 old_gov = policy->governor;
2088 /* end old governor */
2089 if (old_gov) {
2090 __cpufreq_governor(policy, CPUFREQ_GOV_STOP);
2091 up_write(&policy->rwsem);
Stratos Karafotise5c87b72014-03-19 23:29:17 +02002092 __cpufreq_governor(policy, CPUFREQ_GOV_POLICY_EXIT);
Rafael J. Wysockid9a789c2014-02-17 22:56:35 +01002093 down_write(&policy->rwsem);
2094 }
2095
2096 /* start new governor */
2097 policy->governor = new_policy->governor;
2098 if (!__cpufreq_governor(policy, CPUFREQ_GOV_POLICY_INIT)) {
2099 if (!__cpufreq_governor(policy, CPUFREQ_GOV_START))
2100 goto out;
2101
2102 up_write(&policy->rwsem);
2103 __cpufreq_governor(policy, CPUFREQ_GOV_POLICY_EXIT);
2104 down_write(&policy->rwsem);
2105 }
2106
2107 /* new governor failed, so re-start old one */
2108 pr_debug("starting governor %s failed\n", policy->governor->name);
2109 if (old_gov) {
2110 policy->governor = old_gov;
2111 __cpufreq_governor(policy, CPUFREQ_GOV_POLICY_INIT);
2112 __cpufreq_governor(policy, CPUFREQ_GOV_START);
2113 }
2114
2115 return -EINVAL;
2116
2117 out:
2118 pr_debug("governor: change or update limits\n");
2119 return __cpufreq_governor(policy, CPUFREQ_GOV_LIMITS);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002120}
2121
2122/**
Linus Torvalds1da177e2005-04-16 15:20:36 -07002123 * cpufreq_update_policy - re-evaluate an existing cpufreq policy
2124 * @cpu: CPU which shall be re-evaluated
2125 *
Lucas De Marchi25985ed2011-03-30 22:57:33 -03002126 * Useful for policy notifiers which have different necessities
Linus Torvalds1da177e2005-04-16 15:20:36 -07002127 * at different times.
2128 */
2129int cpufreq_update_policy(unsigned int cpu)
2130{
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302131 struct cpufreq_policy *policy = cpufreq_cpu_get(cpu);
2132 struct cpufreq_policy new_policy;
Julia Lawallf1829e42008-07-25 22:44:53 +02002133 int ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002134
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302135 if (!policy) {
Julia Lawallf1829e42008-07-25 22:44:53 +02002136 ret = -ENODEV;
2137 goto no_policy;
2138 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002139
viresh kumarad7722d2013-10-18 19:10:15 +05302140 down_write(&policy->rwsem);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002141
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02002142 pr_debug("updating policy for CPU %u\n", cpu);
Viresh Kumard5b73cd2013-08-06 22:53:06 +05302143 memcpy(&new_policy, policy, sizeof(*policy));
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302144 new_policy.min = policy->user_policy.min;
2145 new_policy.max = policy->user_policy.max;
2146 new_policy.policy = policy->user_policy.policy;
2147 new_policy.governor = policy->user_policy.governor;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002148
Viresh Kumarbb176f72013-06-19 14:19:33 +05302149 /*
2150 * BIOS might change freq behind our back
2151 * -> ask driver for current freq and notify governors about a change
2152 */
Rafael J. Wysocki2ed99e32014-03-12 21:49:33 +01002153 if (cpufreq_driver->get && !cpufreq_driver->setpolicy) {
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302154 new_policy.cur = cpufreq_driver->get(cpu);
Viresh Kumarbd0fa9b2014-02-25 14:29:44 +05302155 if (WARN_ON(!new_policy.cur)) {
2156 ret = -EIO;
2157 goto no_policy;
2158 }
2159
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302160 if (!policy->cur) {
Joe Perchese837f9b2014-03-11 10:03:00 -07002161 pr_debug("Driver did not initialize current freq\n");
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302162 policy->cur = new_policy.cur;
Thomas Renningera85f7bd2006-02-01 11:36:04 +01002163 } else {
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +05302164 if (policy->cur != new_policy.cur && has_target())
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302165 cpufreq_out_of_sync(cpu, policy->cur,
2166 new_policy.cur);
Thomas Renningera85f7bd2006-02-01 11:36:04 +01002167 }
Thomas Renninger0961dd02006-01-26 18:46:33 +01002168 }
2169
Viresh Kumar037ce832013-10-02 14:13:16 +05302170 ret = cpufreq_set_policy(policy, &new_policy);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002171
viresh kumarad7722d2013-10-18 19:10:15 +05302172 up_write(&policy->rwsem);
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08002173
Viresh Kumar3a3e9e02013-08-06 22:53:05 +05302174 cpufreq_cpu_put(policy);
Julia Lawallf1829e42008-07-25 22:44:53 +02002175no_policy:
Linus Torvalds1da177e2005-04-16 15:20:36 -07002176 return ret;
2177}
2178EXPORT_SYMBOL(cpufreq_update_policy);
2179
Paul Gortmaker27609842013-06-19 13:54:04 -04002180static int cpufreq_cpu_callback(struct notifier_block *nfb,
Ashok Rajc32b6b82005-10-30 14:59:54 -08002181 unsigned long action, void *hcpu)
2182{
2183 unsigned int cpu = (unsigned long)hcpu;
Kay Sievers8a25a2f2011-12-21 14:29:42 -08002184 struct device *dev;
Ashok Rajc32b6b82005-10-30 14:59:54 -08002185
Kay Sievers8a25a2f2011-12-21 14:29:42 -08002186 dev = get_cpu_device(cpu);
2187 if (dev) {
Srivatsa S. Bhat5302c3f2013-07-30 04:25:25 +05302188 switch (action & ~CPU_TASKS_FROZEN) {
Ashok Rajc32b6b82005-10-30 14:59:54 -08002189 case CPU_ONLINE:
Viresh Kumar96bbbe42014-03-10 14:53:35 +05302190 __cpufreq_add_dev(dev, NULL);
Ashok Rajc32b6b82005-10-30 14:59:54 -08002191 break;
Srivatsa S. Bhat5302c3f2013-07-30 04:25:25 +05302192
Ashok Rajc32b6b82005-10-30 14:59:54 -08002193 case CPU_DOWN_PREPARE:
Viresh Kumar96bbbe42014-03-10 14:53:35 +05302194 __cpufreq_remove_dev_prepare(dev, NULL);
Srivatsa S. Bhat1aee40a2013-09-07 01:23:27 +05302195 break;
2196
2197 case CPU_POST_DEAD:
Viresh Kumar96bbbe42014-03-10 14:53:35 +05302198 __cpufreq_remove_dev_finish(dev, NULL);
Ashok Rajc32b6b82005-10-30 14:59:54 -08002199 break;
Srivatsa S. Bhat5302c3f2013-07-30 04:25:25 +05302200
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08002201 case CPU_DOWN_FAILED:
Viresh Kumar96bbbe42014-03-10 14:53:35 +05302202 __cpufreq_add_dev(dev, NULL);
Ashok Rajc32b6b82005-10-30 14:59:54 -08002203 break;
2204 }
2205 }
2206 return NOTIFY_OK;
2207}
2208
Neal Buckendahl9c36f742010-06-22 22:02:44 -05002209static struct notifier_block __refdata cpufreq_cpu_notifier = {
Viresh Kumarbb176f72013-06-19 14:19:33 +05302210 .notifier_call = cpufreq_cpu_callback,
Ashok Rajc32b6b82005-10-30 14:59:54 -08002211};
Linus Torvalds1da177e2005-04-16 15:20:36 -07002212
2213/*********************************************************************
Lukasz Majewski6f19efc2013-12-20 15:24:49 +01002214 * BOOST *
2215 *********************************************************************/
2216static int cpufreq_boost_set_sw(int state)
2217{
2218 struct cpufreq_frequency_table *freq_table;
2219 struct cpufreq_policy *policy;
2220 int ret = -EINVAL;
2221
2222 list_for_each_entry(policy, &cpufreq_policy_list, policy_list) {
2223 freq_table = cpufreq_frequency_get_table(policy->cpu);
2224 if (freq_table) {
2225 ret = cpufreq_frequency_table_cpuinfo(policy,
2226 freq_table);
2227 if (ret) {
2228 pr_err("%s: Policy frequency update failed\n",
2229 __func__);
2230 break;
2231 }
2232 policy->user_policy.max = policy->max;
2233 __cpufreq_governor(policy, CPUFREQ_GOV_LIMITS);
2234 }
2235 }
2236
2237 return ret;
2238}
2239
2240int cpufreq_boost_trigger_state(int state)
2241{
2242 unsigned long flags;
2243 int ret = 0;
2244
2245 if (cpufreq_driver->boost_enabled == state)
2246 return 0;
2247
2248 write_lock_irqsave(&cpufreq_driver_lock, flags);
2249 cpufreq_driver->boost_enabled = state;
2250 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
2251
2252 ret = cpufreq_driver->set_boost(state);
2253 if (ret) {
2254 write_lock_irqsave(&cpufreq_driver_lock, flags);
2255 cpufreq_driver->boost_enabled = !state;
2256 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
2257
Joe Perchese837f9b2014-03-11 10:03:00 -07002258 pr_err("%s: Cannot %s BOOST\n",
2259 __func__, state ? "enable" : "disable");
Lukasz Majewski6f19efc2013-12-20 15:24:49 +01002260 }
2261
2262 return ret;
2263}
2264
2265int cpufreq_boost_supported(void)
2266{
2267 if (likely(cpufreq_driver))
2268 return cpufreq_driver->boost_supported;
2269
2270 return 0;
2271}
2272EXPORT_SYMBOL_GPL(cpufreq_boost_supported);
2273
2274int cpufreq_boost_enabled(void)
2275{
2276 return cpufreq_driver->boost_enabled;
2277}
2278EXPORT_SYMBOL_GPL(cpufreq_boost_enabled);
2279
2280/*********************************************************************
Linus Torvalds1da177e2005-04-16 15:20:36 -07002281 * REGISTER / UNREGISTER CPUFREQ DRIVER *
2282 *********************************************************************/
2283
2284/**
2285 * cpufreq_register_driver - register a CPU Frequency driver
2286 * @driver_data: A struct cpufreq_driver containing the values#
2287 * submitted by the CPU Frequency driver.
2288 *
Viresh Kumarbb176f72013-06-19 14:19:33 +05302289 * Registers a CPU Frequency driver to this core code. This code
Linus Torvalds1da177e2005-04-16 15:20:36 -07002290 * returns zero on success, -EBUSY when another driver got here first
Dave Jones32ee8c32006-02-28 00:43:23 -05002291 * (and isn't unregistered in the meantime).
Linus Torvalds1da177e2005-04-16 15:20:36 -07002292 *
2293 */
Linus Torvalds221dee22007-02-26 14:55:48 -08002294int cpufreq_register_driver(struct cpufreq_driver *driver_data)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002295{
2296 unsigned long flags;
2297 int ret;
2298
Konrad Rzeszutek Wilka7b422c2012-03-13 19:18:39 -04002299 if (cpufreq_disabled())
2300 return -ENODEV;
2301
Linus Torvalds1da177e2005-04-16 15:20:36 -07002302 if (!driver_data || !driver_data->verify || !driver_data->init ||
Viresh Kumar9c0ebcf2013-10-25 19:45:48 +05302303 !(driver_data->setpolicy || driver_data->target_index ||
Rafael J. Wysocki98322352014-03-19 12:48:30 +01002304 driver_data->target) ||
2305 (driver_data->setpolicy && (driver_data->target_index ||
2306 driver_data->target)))
Linus Torvalds1da177e2005-04-16 15:20:36 -07002307 return -EINVAL;
2308
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02002309 pr_debug("trying to register driver %s\n", driver_data->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002310
2311 if (driver_data->setpolicy)
2312 driver_data->flags |= CPUFREQ_CONST_LOOPS;
2313
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00002314 write_lock_irqsave(&cpufreq_driver_lock, flags);
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02002315 if (cpufreq_driver) {
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00002316 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
Yinghai Lu4dea58062013-09-18 21:05:20 -07002317 return -EEXIST;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002318 }
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02002319 cpufreq_driver = driver_data;
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00002320 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002321
Lukasz Majewski6f19efc2013-12-20 15:24:49 +01002322 if (cpufreq_boost_supported()) {
2323 /*
2324 * Check if driver provides function to enable boost -
2325 * if not, use cpufreq_boost_set_sw as default
2326 */
2327 if (!cpufreq_driver->set_boost)
2328 cpufreq_driver->set_boost = cpufreq_boost_set_sw;
2329
2330 ret = cpufreq_sysfs_create_file(&boost.attr);
2331 if (ret) {
2332 pr_err("%s: cannot register global BOOST sysfs file\n",
Joe Perchese837f9b2014-03-11 10:03:00 -07002333 __func__);
Lukasz Majewski6f19efc2013-12-20 15:24:49 +01002334 goto err_null_driver;
2335 }
2336 }
2337
Kay Sievers8a25a2f2011-12-21 14:29:42 -08002338 ret = subsys_interface_register(&cpufreq_interface);
Jiri Slaby8f5bc2a2011-03-01 17:41:10 +01002339 if (ret)
Lukasz Majewski6f19efc2013-12-20 15:24:49 +01002340 goto err_boost_unreg;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002341
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02002342 if (!(cpufreq_driver->flags & CPUFREQ_STICKY)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002343 int i;
2344 ret = -ENODEV;
2345
2346 /* check for at least one working CPU */
Mike Travis7a6aedf2008-03-25 15:06:53 -07002347 for (i = 0; i < nr_cpu_ids; i++)
2348 if (cpu_possible(i) && per_cpu(cpufreq_cpu_data, i)) {
Linus Torvalds1da177e2005-04-16 15:20:36 -07002349 ret = 0;
Mike Travis7a6aedf2008-03-25 15:06:53 -07002350 break;
2351 }
Linus Torvalds1da177e2005-04-16 15:20:36 -07002352
2353 /* if all ->init() calls failed, unregister */
2354 if (ret) {
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02002355 pr_debug("no CPU initialized for driver %s\n",
Joe Perchese837f9b2014-03-11 10:03:00 -07002356 driver_data->name);
Kay Sievers8a25a2f2011-12-21 14:29:42 -08002357 goto err_if_unreg;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002358 }
2359 }
2360
Jiri Slaby8f5bc2a2011-03-01 17:41:10 +01002361 register_hotcpu_notifier(&cpufreq_cpu_notifier);
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02002362 pr_debug("driver %s up and running\n", driver_data->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002363
Jiri Slaby8f5bc2a2011-03-01 17:41:10 +01002364 return 0;
Kay Sievers8a25a2f2011-12-21 14:29:42 -08002365err_if_unreg:
2366 subsys_interface_unregister(&cpufreq_interface);
Lukasz Majewski6f19efc2013-12-20 15:24:49 +01002367err_boost_unreg:
2368 if (cpufreq_boost_supported())
2369 cpufreq_sysfs_remove_file(&boost.attr);
Jiri Slaby8f5bc2a2011-03-01 17:41:10 +01002370err_null_driver:
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00002371 write_lock_irqsave(&cpufreq_driver_lock, flags);
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02002372 cpufreq_driver = NULL;
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00002373 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
Dave Jones4d34a672008-02-07 16:33:49 -05002374 return ret;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002375}
2376EXPORT_SYMBOL_GPL(cpufreq_register_driver);
2377
Linus Torvalds1da177e2005-04-16 15:20:36 -07002378/**
2379 * cpufreq_unregister_driver - unregister the current CPUFreq driver
2380 *
Viresh Kumarbb176f72013-06-19 14:19:33 +05302381 * Unregister the current CPUFreq driver. Only call this if you have
Linus Torvalds1da177e2005-04-16 15:20:36 -07002382 * the right to do so, i.e. if you have succeeded in initialising before!
2383 * Returns zero if successful, and -EINVAL if the cpufreq_driver is
2384 * currently not initialised.
2385 */
Linus Torvalds221dee22007-02-26 14:55:48 -08002386int cpufreq_unregister_driver(struct cpufreq_driver *driver)
Linus Torvalds1da177e2005-04-16 15:20:36 -07002387{
2388 unsigned long flags;
2389
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02002390 if (!cpufreq_driver || (driver != cpufreq_driver))
Linus Torvalds1da177e2005-04-16 15:20:36 -07002391 return -EINVAL;
Linus Torvalds1da177e2005-04-16 15:20:36 -07002392
Dominik Brodowski2d06d8c2011-03-27 15:04:46 +02002393 pr_debug("unregistering driver %s\n", driver->name);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002394
Kay Sievers8a25a2f2011-12-21 14:29:42 -08002395 subsys_interface_unregister(&cpufreq_interface);
Lukasz Majewski6f19efc2013-12-20 15:24:49 +01002396 if (cpufreq_boost_supported())
2397 cpufreq_sysfs_remove_file(&boost.attr);
2398
Chandra Seetharaman65edc682006-06-27 02:54:08 -07002399 unregister_hotcpu_notifier(&cpufreq_cpu_notifier);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002400
Viresh Kumar6eed9402013-08-06 22:53:11 +05302401 down_write(&cpufreq_rwsem);
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00002402 write_lock_irqsave(&cpufreq_driver_lock, flags);
Viresh Kumar6eed9402013-08-06 22:53:11 +05302403
Rafael J. Wysocki1c3d85d2013-04-29 00:08:16 +02002404 cpufreq_driver = NULL;
Viresh Kumar6eed9402013-08-06 22:53:11 +05302405
Nathan Zimmer0d1857a2013-02-22 16:24:34 +00002406 write_unlock_irqrestore(&cpufreq_driver_lock, flags);
Viresh Kumar6eed9402013-08-06 22:53:11 +05302407 up_write(&cpufreq_rwsem);
Linus Torvalds1da177e2005-04-16 15:20:36 -07002408
2409 return 0;
2410}
2411EXPORT_SYMBOL_GPL(cpufreq_unregister_driver);
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08002412
2413static int __init cpufreq_core_init(void)
2414{
Konrad Rzeszutek Wilka7b422c2012-03-13 19:18:39 -04002415 if (cpufreq_disabled())
2416 return -ENODEV;
2417
Viresh Kumar2361be22013-05-17 16:09:09 +05302418 cpufreq_global_kobject = kobject_create();
Thomas Renninger8aa84ad2009-07-24 15:25:05 +02002419 BUG_ON(!cpufreq_global_kobject);
2420
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08002421 return 0;
2422}
Venkatesh Pallipadi5a01f2e2007-02-05 16:12:44 -08002423core_initcall(cpufreq_core_init);