xref: /openbmc/linux/drivers/cpufreq/cpufreq.c (revision ce1bcfe94db895cbd6876e176af5824742b29e25)
11da177e4SLinus Torvalds /*
21da177e4SLinus Torvalds  *  linux/drivers/cpufreq/cpufreq.c
31da177e4SLinus Torvalds  *
41da177e4SLinus Torvalds  *  Copyright (C) 2001 Russell King
51da177e4SLinus Torvalds  *            (C) 2002 - 2003 Dominik Brodowski <linux@brodo.de>
6bb176f7dSViresh Kumar  *            (C) 2013 Viresh Kumar <viresh.kumar@linaro.org>
71da177e4SLinus Torvalds  *
8c32b6b8eSAshok Raj  *  Oct 2005 - Ashok Raj <ashok.raj@intel.com>
9c32b6b8eSAshok Raj  *	Added handling for CPU hotplug
108ff69732SDave Jones  *  Feb 2006 - Jacob Shin <jacob.shin@amd.com>
118ff69732SDave Jones  *	Fix handling for CPU hotplug -- affected CPUs
12c32b6b8eSAshok Raj  *
131da177e4SLinus Torvalds  * This program is free software; you can redistribute it and/or modify
141da177e4SLinus Torvalds  * it under the terms of the GNU General Public License version 2 as
151da177e4SLinus Torvalds  * published by the Free Software Foundation.
161da177e4SLinus Torvalds  */
171da177e4SLinus Torvalds 
18db701151SViresh Kumar #define pr_fmt(fmt) KBUILD_MODNAME ": " fmt
19db701151SViresh Kumar 
205ff0a268SViresh Kumar #include <linux/cpu.h>
211da177e4SLinus Torvalds #include <linux/cpufreq.h>
221da177e4SLinus Torvalds #include <linux/delay.h>
231da177e4SLinus Torvalds #include <linux/device.h>
245ff0a268SViresh Kumar #include <linux/init.h>
255ff0a268SViresh Kumar #include <linux/kernel_stat.h>
265ff0a268SViresh Kumar #include <linux/module.h>
273fc54d37Sakpm@osdl.org #include <linux/mutex.h>
285ff0a268SViresh Kumar #include <linux/slab.h>
292f0aea93SViresh Kumar #include <linux/suspend.h>
3090de2a4aSDoug Anderson #include <linux/syscore_ops.h>
315ff0a268SViresh Kumar #include <linux/tick.h>
326f4f2723SThomas Renninger #include <trace/events/power.h>
336f4f2723SThomas Renninger 
341da177e4SLinus Torvalds /**
35cd878479SDave Jones  * The "cpufreq driver" - the arch- or hardware-dependent low
361da177e4SLinus Torvalds  * level driver of CPUFreq support, and its spinlock. This lock
371da177e4SLinus Torvalds  * also protects the cpufreq_cpu_data array.
381da177e4SLinus Torvalds  */
391c3d85ddSRafael J. Wysocki static struct cpufreq_driver *cpufreq_driver;
407a6aedfaSMike Travis static DEFINE_PER_CPU(struct cpufreq_policy *, cpufreq_cpu_data);
418414809cSSrivatsa S. Bhat static DEFINE_PER_CPU(struct cpufreq_policy *, cpufreq_cpu_data_fallback);
42bb176f7dSViresh Kumar static DEFINE_RWLOCK(cpufreq_driver_lock);
436f1e4efdSJane Li DEFINE_MUTEX(cpufreq_governor_lock);
44c88a1f8bSLukasz Majewski static LIST_HEAD(cpufreq_policy_list);
45bb176f7dSViresh Kumar 
46084f3493SThomas Renninger /* This one keeps track of the previously set governor of a removed CPU */
47e77b89f1SDmitry Monakhov static DEFINE_PER_CPU(char[CPUFREQ_NAME_LEN], cpufreq_cpu_governor);
481da177e4SLinus Torvalds 
492f0aea93SViresh Kumar /* Flag to suspend/resume CPUFreq governors */
502f0aea93SViresh Kumar static bool cpufreq_suspended;
511da177e4SLinus Torvalds 
529c0ebcf7SViresh Kumar static inline bool has_target(void)
539c0ebcf7SViresh Kumar {
549c0ebcf7SViresh Kumar 	return cpufreq_driver->target_index || cpufreq_driver->target;
559c0ebcf7SViresh Kumar }
569c0ebcf7SViresh Kumar 
575a01f2e8SVenkatesh Pallipadi /*
586eed9404SViresh Kumar  * rwsem to guarantee that cpufreq driver module doesn't unload during critical
596eed9404SViresh Kumar  * sections
606eed9404SViresh Kumar  */
616eed9404SViresh Kumar static DECLARE_RWSEM(cpufreq_rwsem);
626eed9404SViresh Kumar 
631da177e4SLinus Torvalds /* internal prototypes */
6429464f28SDave Jones static int __cpufreq_governor(struct cpufreq_policy *policy,
6529464f28SDave Jones 		unsigned int event);
66d92d50a4SViresh Kumar static unsigned int __cpufreq_get(struct cpufreq_policy *policy);
6765f27f38SDavid Howells static void handle_update(struct work_struct *work);
681da177e4SLinus Torvalds 
691da177e4SLinus Torvalds /**
701da177e4SLinus Torvalds  * Two notifier lists: the "policy" list is involved in the
711da177e4SLinus Torvalds  * validation process for a new CPU frequency policy; the
721da177e4SLinus Torvalds  * "transition" list for kernel code that needs to handle
731da177e4SLinus Torvalds  * changes to devices when the CPU clock speed changes.
741da177e4SLinus Torvalds  * The mutex locks both lists.
751da177e4SLinus Torvalds  */
76e041c683SAlan Stern static BLOCKING_NOTIFIER_HEAD(cpufreq_policy_notifier_list);
77b4dfdbb3SAlan Stern static struct srcu_notifier_head cpufreq_transition_notifier_list;
781da177e4SLinus Torvalds 
7974212ca4SCesar Eduardo Barros static bool init_cpufreq_transition_notifier_list_called;
80b4dfdbb3SAlan Stern static int __init init_cpufreq_transition_notifier_list(void)
81b4dfdbb3SAlan Stern {
82b4dfdbb3SAlan Stern 	srcu_init_notifier_head(&cpufreq_transition_notifier_list);
8374212ca4SCesar Eduardo Barros 	init_cpufreq_transition_notifier_list_called = true;
84b4dfdbb3SAlan Stern 	return 0;
85b4dfdbb3SAlan Stern }
86b3438f82SLinus Torvalds pure_initcall(init_cpufreq_transition_notifier_list);
871da177e4SLinus Torvalds 
88a7b422cdSKonrad Rzeszutek Wilk static int off __read_mostly;
89da584455SViresh Kumar static int cpufreq_disabled(void)
90a7b422cdSKonrad Rzeszutek Wilk {
91a7b422cdSKonrad Rzeszutek Wilk 	return off;
92a7b422cdSKonrad Rzeszutek Wilk }
93a7b422cdSKonrad Rzeszutek Wilk void disable_cpufreq(void)
94a7b422cdSKonrad Rzeszutek Wilk {
95a7b422cdSKonrad Rzeszutek Wilk 	off = 1;
96a7b422cdSKonrad Rzeszutek Wilk }
971da177e4SLinus Torvalds static LIST_HEAD(cpufreq_governor_list);
983fc54d37Sakpm@osdl.org static DEFINE_MUTEX(cpufreq_governor_mutex);
991da177e4SLinus Torvalds 
1004d5dcc42SViresh Kumar bool have_governor_per_policy(void)
1014d5dcc42SViresh Kumar {
1020b981e70SViresh Kumar 	return !!(cpufreq_driver->flags & CPUFREQ_HAVE_GOVERNOR_PER_POLICY);
1034d5dcc42SViresh Kumar }
1043f869d6dSViresh Kumar EXPORT_SYMBOL_GPL(have_governor_per_policy);
1054d5dcc42SViresh Kumar 
106944e9a03SViresh Kumar struct kobject *get_governor_parent_kobj(struct cpufreq_policy *policy)
107944e9a03SViresh Kumar {
108944e9a03SViresh Kumar 	if (have_governor_per_policy())
109944e9a03SViresh Kumar 		return &policy->kobj;
110944e9a03SViresh Kumar 	else
111944e9a03SViresh Kumar 		return cpufreq_global_kobject;
112944e9a03SViresh Kumar }
113944e9a03SViresh Kumar EXPORT_SYMBOL_GPL(get_governor_parent_kobj);
114944e9a03SViresh Kumar 
11572a4ce34SViresh Kumar static inline u64 get_cpu_idle_time_jiffy(unsigned int cpu, u64 *wall)
11672a4ce34SViresh Kumar {
11772a4ce34SViresh Kumar 	u64 idle_time;
11872a4ce34SViresh Kumar 	u64 cur_wall_time;
11972a4ce34SViresh Kumar 	u64 busy_time;
12072a4ce34SViresh Kumar 
12172a4ce34SViresh Kumar 	cur_wall_time = jiffies64_to_cputime64(get_jiffies_64());
12272a4ce34SViresh Kumar 
12372a4ce34SViresh Kumar 	busy_time = kcpustat_cpu(cpu).cpustat[CPUTIME_USER];
12472a4ce34SViresh Kumar 	busy_time += kcpustat_cpu(cpu).cpustat[CPUTIME_SYSTEM];
12572a4ce34SViresh Kumar 	busy_time += kcpustat_cpu(cpu).cpustat[CPUTIME_IRQ];
12672a4ce34SViresh Kumar 	busy_time += kcpustat_cpu(cpu).cpustat[CPUTIME_SOFTIRQ];
12772a4ce34SViresh Kumar 	busy_time += kcpustat_cpu(cpu).cpustat[CPUTIME_STEAL];
12872a4ce34SViresh Kumar 	busy_time += kcpustat_cpu(cpu).cpustat[CPUTIME_NICE];
12972a4ce34SViresh Kumar 
13072a4ce34SViresh Kumar 	idle_time = cur_wall_time - busy_time;
13172a4ce34SViresh Kumar 	if (wall)
13272a4ce34SViresh Kumar 		*wall = cputime_to_usecs(cur_wall_time);
13372a4ce34SViresh Kumar 
13472a4ce34SViresh Kumar 	return cputime_to_usecs(idle_time);
13572a4ce34SViresh Kumar }
13672a4ce34SViresh Kumar 
13772a4ce34SViresh Kumar u64 get_cpu_idle_time(unsigned int cpu, u64 *wall, int io_busy)
13872a4ce34SViresh Kumar {
13972a4ce34SViresh Kumar 	u64 idle_time = get_cpu_idle_time_us(cpu, io_busy ? wall : NULL);
14072a4ce34SViresh Kumar 
14172a4ce34SViresh Kumar 	if (idle_time == -1ULL)
14272a4ce34SViresh Kumar 		return get_cpu_idle_time_jiffy(cpu, wall);
14372a4ce34SViresh Kumar 	else if (!io_busy)
14472a4ce34SViresh Kumar 		idle_time += get_cpu_iowait_time_us(cpu, wall);
14572a4ce34SViresh Kumar 
14672a4ce34SViresh Kumar 	return idle_time;
14772a4ce34SViresh Kumar }
14872a4ce34SViresh Kumar EXPORT_SYMBOL_GPL(get_cpu_idle_time);
14972a4ce34SViresh Kumar 
15070e9e778SViresh Kumar /*
15170e9e778SViresh Kumar  * This is a generic cpufreq init() routine which can be used by cpufreq
15270e9e778SViresh Kumar  * drivers of SMP systems. It will do following:
15370e9e778SViresh Kumar  * - validate & show freq table passed
15470e9e778SViresh Kumar  * - set policies transition latency
15570e9e778SViresh Kumar  * - policy->cpus with all possible CPUs
15670e9e778SViresh Kumar  */
15770e9e778SViresh Kumar int cpufreq_generic_init(struct cpufreq_policy *policy,
15870e9e778SViresh Kumar 		struct cpufreq_frequency_table *table,
15970e9e778SViresh Kumar 		unsigned int transition_latency)
16070e9e778SViresh Kumar {
16170e9e778SViresh Kumar 	int ret;
16270e9e778SViresh Kumar 
16370e9e778SViresh Kumar 	ret = cpufreq_table_validate_and_show(policy, table);
16470e9e778SViresh Kumar 	if (ret) {
16570e9e778SViresh Kumar 		pr_err("%s: invalid frequency table: %d\n", __func__, ret);
16670e9e778SViresh Kumar 		return ret;
16770e9e778SViresh Kumar 	}
16870e9e778SViresh Kumar 
16970e9e778SViresh Kumar 	policy->cpuinfo.transition_latency = transition_latency;
17070e9e778SViresh Kumar 
17170e9e778SViresh Kumar 	/*
17270e9e778SViresh Kumar 	 * The driver only supports the SMP configuartion where all processors
17370e9e778SViresh Kumar 	 * share the clock and voltage and clock.
17470e9e778SViresh Kumar 	 */
17570e9e778SViresh Kumar 	cpumask_setall(policy->cpus);
17670e9e778SViresh Kumar 
17770e9e778SViresh Kumar 	return 0;
17870e9e778SViresh Kumar }
17970e9e778SViresh Kumar EXPORT_SYMBOL_GPL(cpufreq_generic_init);
18070e9e778SViresh Kumar 
181652ed95dSViresh Kumar unsigned int cpufreq_generic_get(unsigned int cpu)
182652ed95dSViresh Kumar {
183652ed95dSViresh Kumar 	struct cpufreq_policy *policy = per_cpu(cpufreq_cpu_data, cpu);
184652ed95dSViresh Kumar 
185652ed95dSViresh Kumar 	if (!policy || IS_ERR(policy->clk)) {
186e837f9b5SJoe Perches 		pr_err("%s: No %s associated to cpu: %d\n",
187e837f9b5SJoe Perches 		       __func__, policy ? "clk" : "policy", cpu);
188652ed95dSViresh Kumar 		return 0;
189652ed95dSViresh Kumar 	}
190652ed95dSViresh Kumar 
191652ed95dSViresh Kumar 	return clk_get_rate(policy->clk) / 1000;
192652ed95dSViresh Kumar }
193652ed95dSViresh Kumar EXPORT_SYMBOL_GPL(cpufreq_generic_get);
194652ed95dSViresh Kumar 
195e0b3165bSViresh Kumar /* Only for cpufreq core internal use */
196e0b3165bSViresh Kumar struct cpufreq_policy *cpufreq_cpu_get_raw(unsigned int cpu)
197e0b3165bSViresh Kumar {
198e0b3165bSViresh Kumar 	return per_cpu(cpufreq_cpu_data, cpu);
199e0b3165bSViresh Kumar }
200e0b3165bSViresh Kumar 
2016eed9404SViresh Kumar struct cpufreq_policy *cpufreq_cpu_get(unsigned int cpu)
2021da177e4SLinus Torvalds {
2036eed9404SViresh Kumar 	struct cpufreq_policy *policy = NULL;
2041da177e4SLinus Torvalds 	unsigned long flags;
2051da177e4SLinus Torvalds 
2066eed9404SViresh Kumar 	if (cpufreq_disabled() || (cpu >= nr_cpu_ids))
2076eed9404SViresh Kumar 		return NULL;
2086eed9404SViresh Kumar 
2096eed9404SViresh Kumar 	if (!down_read_trylock(&cpufreq_rwsem))
2106eed9404SViresh Kumar 		return NULL;
2111da177e4SLinus Torvalds 
2121da177e4SLinus Torvalds 	/* get the cpufreq driver */
2130d1857a1SNathan Zimmer 	read_lock_irqsave(&cpufreq_driver_lock, flags);
2141da177e4SLinus Torvalds 
2156eed9404SViresh Kumar 	if (cpufreq_driver) {
2161da177e4SLinus Torvalds 		/* get the CPU */
2173a3e9e06SViresh Kumar 		policy = per_cpu(cpufreq_cpu_data, cpu);
2186eed9404SViresh Kumar 		if (policy)
2196eed9404SViresh Kumar 			kobject_get(&policy->kobj);
2206eed9404SViresh Kumar 	}
2216eed9404SViresh Kumar 
2226eed9404SViresh Kumar 	read_unlock_irqrestore(&cpufreq_driver_lock, flags);
2231da177e4SLinus Torvalds 
2243a3e9e06SViresh Kumar 	if (!policy)
2256eed9404SViresh Kumar 		up_read(&cpufreq_rwsem);
2261da177e4SLinus Torvalds 
2273a3e9e06SViresh Kumar 	return policy;
228a9144436SStephen Boyd }
2291da177e4SLinus Torvalds EXPORT_SYMBOL_GPL(cpufreq_cpu_get);
2301da177e4SLinus Torvalds 
2313a3e9e06SViresh Kumar void cpufreq_cpu_put(struct cpufreq_policy *policy)
232a9144436SStephen Boyd {
233d5aaffa9SDirk Brandewie 	if (cpufreq_disabled())
234d5aaffa9SDirk Brandewie 		return;
235d5aaffa9SDirk Brandewie 
2366eed9404SViresh Kumar 	kobject_put(&policy->kobj);
2376eed9404SViresh Kumar 	up_read(&cpufreq_rwsem);
238a9144436SStephen Boyd }
2391da177e4SLinus Torvalds EXPORT_SYMBOL_GPL(cpufreq_cpu_put);
2401da177e4SLinus Torvalds 
2411da177e4SLinus Torvalds /*********************************************************************
2421da177e4SLinus Torvalds  *            EXTERNALLY AFFECTING FREQUENCY CHANGES                 *
2431da177e4SLinus Torvalds  *********************************************************************/
2441da177e4SLinus Torvalds 
2451da177e4SLinus Torvalds /**
2461da177e4SLinus Torvalds  * adjust_jiffies - adjust the system "loops_per_jiffy"
2471da177e4SLinus Torvalds  *
2481da177e4SLinus Torvalds  * This function alters the system "loops_per_jiffy" for the clock
2491da177e4SLinus Torvalds  * speed change. Note that loops_per_jiffy cannot be updated on SMP
2501da177e4SLinus Torvalds  * systems as each CPU might be scaled differently. So, use the arch
2511da177e4SLinus Torvalds  * per-CPU loops_per_jiffy value wherever possible.
2521da177e4SLinus Torvalds  */
25339c132eeSViresh Kumar static void adjust_jiffies(unsigned long val, struct cpufreq_freqs *ci)
25439c132eeSViresh Kumar {
2551da177e4SLinus Torvalds #ifndef CONFIG_SMP
2561da177e4SLinus Torvalds 	static unsigned long l_p_j_ref;
2571da177e4SLinus Torvalds 	static unsigned int l_p_j_ref_freq;
2581da177e4SLinus Torvalds 
2591da177e4SLinus Torvalds 	if (ci->flags & CPUFREQ_CONST_LOOPS)
2601da177e4SLinus Torvalds 		return;
2611da177e4SLinus Torvalds 
2621da177e4SLinus Torvalds 	if (!l_p_j_ref_freq) {
2631da177e4SLinus Torvalds 		l_p_j_ref = loops_per_jiffy;
2641da177e4SLinus Torvalds 		l_p_j_ref_freq = ci->old;
265e837f9b5SJoe Perches 		pr_debug("saving %lu as reference value for loops_per_jiffy; freq is %u kHz\n",
266e837f9b5SJoe Perches 			 l_p_j_ref, l_p_j_ref_freq);
2671da177e4SLinus Torvalds 	}
2680b443eadSViresh Kumar 	if (val == CPUFREQ_POSTCHANGE && ci->old != ci->new) {
269e08f5f5bSGautham R Shenoy 		loops_per_jiffy = cpufreq_scale(l_p_j_ref, l_p_j_ref_freq,
270e08f5f5bSGautham R Shenoy 								ci->new);
271e837f9b5SJoe Perches 		pr_debug("scaling loops_per_jiffy to %lu for frequency %u kHz\n",
272e837f9b5SJoe Perches 			 loops_per_jiffy, ci->new);
2731da177e4SLinus Torvalds 	}
2741da177e4SLinus Torvalds #endif
27539c132eeSViresh Kumar }
2761da177e4SLinus Torvalds 
2770956df9cSViresh Kumar static void __cpufreq_notify_transition(struct cpufreq_policy *policy,
278b43a7ffbSViresh Kumar 		struct cpufreq_freqs *freqs, unsigned int state)
2791da177e4SLinus Torvalds {
2801da177e4SLinus Torvalds 	BUG_ON(irqs_disabled());
2811da177e4SLinus Torvalds 
282d5aaffa9SDirk Brandewie 	if (cpufreq_disabled())
283d5aaffa9SDirk Brandewie 		return;
284d5aaffa9SDirk Brandewie 
2851c3d85ddSRafael J. Wysocki 	freqs->flags = cpufreq_driver->flags;
2862d06d8c4SDominik Brodowski 	pr_debug("notification %u of frequency transition to %u kHz\n",
287e4472cb3SDave Jones 		 state, freqs->new);
2881da177e4SLinus Torvalds 
2891da177e4SLinus Torvalds 	switch (state) {
290e4472cb3SDave Jones 
2911da177e4SLinus Torvalds 	case CPUFREQ_PRECHANGE:
292e4472cb3SDave Jones 		/* detect if the driver reported a value as "old frequency"
293e4472cb3SDave Jones 		 * which is not equal to what the cpufreq core thinks is
294e4472cb3SDave Jones 		 * "old frequency".
2951da177e4SLinus Torvalds 		 */
2961c3d85ddSRafael J. Wysocki 		if (!(cpufreq_driver->flags & CPUFREQ_CONST_LOOPS)) {
297e4472cb3SDave Jones 			if ((policy) && (policy->cpu == freqs->cpu) &&
298e4472cb3SDave Jones 			    (policy->cur) && (policy->cur != freqs->old)) {
299e837f9b5SJoe Perches 				pr_debug("Warning: CPU frequency is %u, cpufreq assumed %u kHz\n",
300e4472cb3SDave Jones 					 freqs->old, policy->cur);
301e4472cb3SDave Jones 				freqs->old = policy->cur;
3021da177e4SLinus Torvalds 			}
3031da177e4SLinus Torvalds 		}
304b4dfdbb3SAlan Stern 		srcu_notifier_call_chain(&cpufreq_transition_notifier_list,
305e4472cb3SDave Jones 				CPUFREQ_PRECHANGE, freqs);
3061da177e4SLinus Torvalds 		adjust_jiffies(CPUFREQ_PRECHANGE, freqs);
3071da177e4SLinus Torvalds 		break;
308e4472cb3SDave Jones 
3091da177e4SLinus Torvalds 	case CPUFREQ_POSTCHANGE:
3101da177e4SLinus Torvalds 		adjust_jiffies(CPUFREQ_POSTCHANGE, freqs);
311e837f9b5SJoe Perches 		pr_debug("FREQ: %lu - CPU: %lu\n",
312e837f9b5SJoe Perches 			 (unsigned long)freqs->new, (unsigned long)freqs->cpu);
31325e41933SThomas Renninger 		trace_cpu_frequency(freqs->new, freqs->cpu);
314b4dfdbb3SAlan Stern 		srcu_notifier_call_chain(&cpufreq_transition_notifier_list,
315e4472cb3SDave Jones 				CPUFREQ_POSTCHANGE, freqs);
316e4472cb3SDave Jones 		if (likely(policy) && likely(policy->cpu == freqs->cpu))
317e4472cb3SDave Jones 			policy->cur = freqs->new;
3181da177e4SLinus Torvalds 		break;
3191da177e4SLinus Torvalds 	}
3201da177e4SLinus Torvalds }
321bb176f7dSViresh Kumar 
322b43a7ffbSViresh Kumar /**
323b43a7ffbSViresh Kumar  * cpufreq_notify_transition - call notifier chain and adjust_jiffies
324b43a7ffbSViresh Kumar  * on frequency transition.
325b43a7ffbSViresh Kumar  *
326b43a7ffbSViresh Kumar  * This function calls the transition notifiers and the "adjust_jiffies"
327b43a7ffbSViresh Kumar  * function. It is called twice on all CPU frequency changes that have
328b43a7ffbSViresh Kumar  * external effects.
329b43a7ffbSViresh Kumar  */
330236a9800SViresh Kumar static void cpufreq_notify_transition(struct cpufreq_policy *policy,
331b43a7ffbSViresh Kumar 		struct cpufreq_freqs *freqs, unsigned int state)
332b43a7ffbSViresh Kumar {
333b43a7ffbSViresh Kumar 	for_each_cpu(freqs->cpu, policy->cpus)
334b43a7ffbSViresh Kumar 		__cpufreq_notify_transition(policy, freqs, state);
335b43a7ffbSViresh Kumar }
3361da177e4SLinus Torvalds 
337f7ba3b41SViresh Kumar /* Do post notifications when there are chances that transition has failed */
338236a9800SViresh Kumar static void cpufreq_notify_post_transition(struct cpufreq_policy *policy,
339f7ba3b41SViresh Kumar 		struct cpufreq_freqs *freqs, int transition_failed)
340f7ba3b41SViresh Kumar {
341f7ba3b41SViresh Kumar 	cpufreq_notify_transition(policy, freqs, CPUFREQ_POSTCHANGE);
342f7ba3b41SViresh Kumar 	if (!transition_failed)
343f7ba3b41SViresh Kumar 		return;
344f7ba3b41SViresh Kumar 
345f7ba3b41SViresh Kumar 	swap(freqs->old, freqs->new);
346f7ba3b41SViresh Kumar 	cpufreq_notify_transition(policy, freqs, CPUFREQ_PRECHANGE);
347f7ba3b41SViresh Kumar 	cpufreq_notify_transition(policy, freqs, CPUFREQ_POSTCHANGE);
348f7ba3b41SViresh Kumar }
349f7ba3b41SViresh Kumar 
35012478cf0SSrivatsa S. Bhat void cpufreq_freq_transition_begin(struct cpufreq_policy *policy,
35112478cf0SSrivatsa S. Bhat 		struct cpufreq_freqs *freqs)
35212478cf0SSrivatsa S. Bhat {
353ca654dc3SSrivatsa S. Bhat 
354ca654dc3SSrivatsa S. Bhat 	/*
355ca654dc3SSrivatsa S. Bhat 	 * Catch double invocations of _begin() which lead to self-deadlock.
356ca654dc3SSrivatsa S. Bhat 	 * ASYNC_NOTIFICATION drivers are left out because the cpufreq core
357ca654dc3SSrivatsa S. Bhat 	 * doesn't invoke _begin() on their behalf, and hence the chances of
358ca654dc3SSrivatsa S. Bhat 	 * double invocations are very low. Moreover, there are scenarios
359ca654dc3SSrivatsa S. Bhat 	 * where these checks can emit false-positive warnings in these
360ca654dc3SSrivatsa S. Bhat 	 * drivers; so we avoid that by skipping them altogether.
361ca654dc3SSrivatsa S. Bhat 	 */
362ca654dc3SSrivatsa S. Bhat 	WARN_ON(!(cpufreq_driver->flags & CPUFREQ_ASYNC_NOTIFICATION)
363ca654dc3SSrivatsa S. Bhat 				&& current == policy->transition_task);
364ca654dc3SSrivatsa S. Bhat 
36512478cf0SSrivatsa S. Bhat wait:
36612478cf0SSrivatsa S. Bhat 	wait_event(policy->transition_wait, !policy->transition_ongoing);
36712478cf0SSrivatsa S. Bhat 
36812478cf0SSrivatsa S. Bhat 	spin_lock(&policy->transition_lock);
36912478cf0SSrivatsa S. Bhat 
37012478cf0SSrivatsa S. Bhat 	if (unlikely(policy->transition_ongoing)) {
37112478cf0SSrivatsa S. Bhat 		spin_unlock(&policy->transition_lock);
37212478cf0SSrivatsa S. Bhat 		goto wait;
37312478cf0SSrivatsa S. Bhat 	}
37412478cf0SSrivatsa S. Bhat 
37512478cf0SSrivatsa S. Bhat 	policy->transition_ongoing = true;
376ca654dc3SSrivatsa S. Bhat 	policy->transition_task = current;
37712478cf0SSrivatsa S. Bhat 
37812478cf0SSrivatsa S. Bhat 	spin_unlock(&policy->transition_lock);
37912478cf0SSrivatsa S. Bhat 
38012478cf0SSrivatsa S. Bhat 	cpufreq_notify_transition(policy, freqs, CPUFREQ_PRECHANGE);
38112478cf0SSrivatsa S. Bhat }
38212478cf0SSrivatsa S. Bhat EXPORT_SYMBOL_GPL(cpufreq_freq_transition_begin);
38312478cf0SSrivatsa S. Bhat 
38412478cf0SSrivatsa S. Bhat void cpufreq_freq_transition_end(struct cpufreq_policy *policy,
38512478cf0SSrivatsa S. Bhat 		struct cpufreq_freqs *freqs, int transition_failed)
38612478cf0SSrivatsa S. Bhat {
38712478cf0SSrivatsa S. Bhat 	if (unlikely(WARN_ON(!policy->transition_ongoing)))
38812478cf0SSrivatsa S. Bhat 		return;
38912478cf0SSrivatsa S. Bhat 
39012478cf0SSrivatsa S. Bhat 	cpufreq_notify_post_transition(policy, freqs, transition_failed);
39112478cf0SSrivatsa S. Bhat 
39212478cf0SSrivatsa S. Bhat 	policy->transition_ongoing = false;
393ca654dc3SSrivatsa S. Bhat 	policy->transition_task = NULL;
39412478cf0SSrivatsa S. Bhat 
39512478cf0SSrivatsa S. Bhat 	wake_up(&policy->transition_wait);
39612478cf0SSrivatsa S. Bhat }
39712478cf0SSrivatsa S. Bhat EXPORT_SYMBOL_GPL(cpufreq_freq_transition_end);
39812478cf0SSrivatsa S. Bhat 
3991da177e4SLinus Torvalds 
4001da177e4SLinus Torvalds /*********************************************************************
4011da177e4SLinus Torvalds  *                          SYSFS INTERFACE                          *
4021da177e4SLinus Torvalds  *********************************************************************/
4038a5c74a1SRashika Kheria static ssize_t show_boost(struct kobject *kobj,
4046f19efc0SLukasz Majewski 				 struct attribute *attr, char *buf)
4056f19efc0SLukasz Majewski {
4066f19efc0SLukasz Majewski 	return sprintf(buf, "%d\n", cpufreq_driver->boost_enabled);
4076f19efc0SLukasz Majewski }
4086f19efc0SLukasz Majewski 
4096f19efc0SLukasz Majewski static ssize_t store_boost(struct kobject *kobj, struct attribute *attr,
4106f19efc0SLukasz Majewski 				  const char *buf, size_t count)
4116f19efc0SLukasz Majewski {
4126f19efc0SLukasz Majewski 	int ret, enable;
4136f19efc0SLukasz Majewski 
4146f19efc0SLukasz Majewski 	ret = sscanf(buf, "%d", &enable);
4156f19efc0SLukasz Majewski 	if (ret != 1 || enable < 0 || enable > 1)
4166f19efc0SLukasz Majewski 		return -EINVAL;
4176f19efc0SLukasz Majewski 
4186f19efc0SLukasz Majewski 	if (cpufreq_boost_trigger_state(enable)) {
419e837f9b5SJoe Perches 		pr_err("%s: Cannot %s BOOST!\n",
420e837f9b5SJoe Perches 		       __func__, enable ? "enable" : "disable");
4216f19efc0SLukasz Majewski 		return -EINVAL;
4226f19efc0SLukasz Majewski 	}
4236f19efc0SLukasz Majewski 
424e837f9b5SJoe Perches 	pr_debug("%s: cpufreq BOOST %s\n",
425e837f9b5SJoe Perches 		 __func__, enable ? "enabled" : "disabled");
4266f19efc0SLukasz Majewski 
4276f19efc0SLukasz Majewski 	return count;
4286f19efc0SLukasz Majewski }
4296f19efc0SLukasz Majewski define_one_global_rw(boost);
4301da177e4SLinus Torvalds 
43142f91fa1SViresh Kumar static struct cpufreq_governor *find_governor(const char *str_governor)
4323bcb09a3SJeremy Fitzhardinge {
4333bcb09a3SJeremy Fitzhardinge 	struct cpufreq_governor *t;
4343bcb09a3SJeremy Fitzhardinge 
4353bcb09a3SJeremy Fitzhardinge 	list_for_each_entry(t, &cpufreq_governor_list, governor_list)
4367c4f4539SRasmus Villemoes 		if (!strncasecmp(str_governor, t->name, CPUFREQ_NAME_LEN))
4373bcb09a3SJeremy Fitzhardinge 			return t;
4383bcb09a3SJeremy Fitzhardinge 
4393bcb09a3SJeremy Fitzhardinge 	return NULL;
4403bcb09a3SJeremy Fitzhardinge }
4413bcb09a3SJeremy Fitzhardinge 
4421da177e4SLinus Torvalds /**
4431da177e4SLinus Torvalds  * cpufreq_parse_governor - parse a governor string
4441da177e4SLinus Torvalds  */
4451da177e4SLinus Torvalds static int cpufreq_parse_governor(char *str_governor, unsigned int *policy,
4461da177e4SLinus Torvalds 				struct cpufreq_governor **governor)
4471da177e4SLinus Torvalds {
4483bcb09a3SJeremy Fitzhardinge 	int err = -EINVAL;
4493bcb09a3SJeremy Fitzhardinge 
4501c3d85ddSRafael J. Wysocki 	if (!cpufreq_driver)
4513bcb09a3SJeremy Fitzhardinge 		goto out;
4523bcb09a3SJeremy Fitzhardinge 
4531c3d85ddSRafael J. Wysocki 	if (cpufreq_driver->setpolicy) {
4547c4f4539SRasmus Villemoes 		if (!strncasecmp(str_governor, "performance", CPUFREQ_NAME_LEN)) {
4551da177e4SLinus Torvalds 			*policy = CPUFREQ_POLICY_PERFORMANCE;
4563bcb09a3SJeremy Fitzhardinge 			err = 0;
4577c4f4539SRasmus Villemoes 		} else if (!strncasecmp(str_governor, "powersave",
458e08f5f5bSGautham R Shenoy 						CPUFREQ_NAME_LEN)) {
4591da177e4SLinus Torvalds 			*policy = CPUFREQ_POLICY_POWERSAVE;
4603bcb09a3SJeremy Fitzhardinge 			err = 0;
4611da177e4SLinus Torvalds 		}
4622e1cc3a5SViresh Kumar 	} else {
4631da177e4SLinus Torvalds 		struct cpufreq_governor *t;
4643bcb09a3SJeremy Fitzhardinge 
4653fc54d37Sakpm@osdl.org 		mutex_lock(&cpufreq_governor_mutex);
4663bcb09a3SJeremy Fitzhardinge 
46742f91fa1SViresh Kumar 		t = find_governor(str_governor);
4683bcb09a3SJeremy Fitzhardinge 
469ea714970SJeremy Fitzhardinge 		if (t == NULL) {
470ea714970SJeremy Fitzhardinge 			int ret;
471ea714970SJeremy Fitzhardinge 
472ea714970SJeremy Fitzhardinge 			mutex_unlock(&cpufreq_governor_mutex);
4731a8e1463SKees Cook 			ret = request_module("cpufreq_%s", str_governor);
474ea714970SJeremy Fitzhardinge 			mutex_lock(&cpufreq_governor_mutex);
475ea714970SJeremy Fitzhardinge 
476ea714970SJeremy Fitzhardinge 			if (ret == 0)
47742f91fa1SViresh Kumar 				t = find_governor(str_governor);
478ea714970SJeremy Fitzhardinge 		}
479ea714970SJeremy Fitzhardinge 
4803bcb09a3SJeremy Fitzhardinge 		if (t != NULL) {
4811da177e4SLinus Torvalds 			*governor = t;
4823bcb09a3SJeremy Fitzhardinge 			err = 0;
4831da177e4SLinus Torvalds 		}
4843bcb09a3SJeremy Fitzhardinge 
4853bcb09a3SJeremy Fitzhardinge 		mutex_unlock(&cpufreq_governor_mutex);
4861da177e4SLinus Torvalds 	}
4871da177e4SLinus Torvalds out:
4883bcb09a3SJeremy Fitzhardinge 	return err;
4891da177e4SLinus Torvalds }
4901da177e4SLinus Torvalds 
4911da177e4SLinus Torvalds /**
492e08f5f5bSGautham R Shenoy  * cpufreq_per_cpu_attr_read() / show_##file_name() -
493e08f5f5bSGautham R Shenoy  * print out cpufreq information
4941da177e4SLinus Torvalds  *
4951da177e4SLinus Torvalds  * Write out information from cpufreq_driver->policy[cpu]; object must be
4961da177e4SLinus Torvalds  * "unsigned int".
4971da177e4SLinus Torvalds  */
4981da177e4SLinus Torvalds 
4991da177e4SLinus Torvalds #define show_one(file_name, object)			\
5001da177e4SLinus Torvalds static ssize_t show_##file_name				\
5011da177e4SLinus Torvalds (struct cpufreq_policy *policy, char *buf)		\
5021da177e4SLinus Torvalds {							\
5031da177e4SLinus Torvalds 	return sprintf(buf, "%u\n", policy->object);	\
5041da177e4SLinus Torvalds }
5051da177e4SLinus Torvalds 
5061da177e4SLinus Torvalds show_one(cpuinfo_min_freq, cpuinfo.min_freq);
5071da177e4SLinus Torvalds show_one(cpuinfo_max_freq, cpuinfo.max_freq);
508ed129784SThomas Renninger show_one(cpuinfo_transition_latency, cpuinfo.transition_latency);
5091da177e4SLinus Torvalds show_one(scaling_min_freq, min);
5101da177e4SLinus Torvalds show_one(scaling_max_freq, max);
511c034b02eSDirk Brandewie 
51209347b29SViresh Kumar static ssize_t show_scaling_cur_freq(struct cpufreq_policy *policy, char *buf)
513c034b02eSDirk Brandewie {
514c034b02eSDirk Brandewie 	ssize_t ret;
515c034b02eSDirk Brandewie 
516c034b02eSDirk Brandewie 	if (cpufreq_driver && cpufreq_driver->setpolicy && cpufreq_driver->get)
517c034b02eSDirk Brandewie 		ret = sprintf(buf, "%u\n", cpufreq_driver->get(policy->cpu));
518c034b02eSDirk Brandewie 	else
519c034b02eSDirk Brandewie 		ret = sprintf(buf, "%u\n", policy->cur);
520c034b02eSDirk Brandewie 	return ret;
521c034b02eSDirk Brandewie }
5221da177e4SLinus Torvalds 
523037ce839SViresh Kumar static int cpufreq_set_policy(struct cpufreq_policy *policy,
5243a3e9e06SViresh Kumar 				struct cpufreq_policy *new_policy);
5257970e08bSThomas Renninger 
5261da177e4SLinus Torvalds /**
5271da177e4SLinus Torvalds  * cpufreq_per_cpu_attr_write() / store_##file_name() - sysfs write access
5281da177e4SLinus Torvalds  */
5291da177e4SLinus Torvalds #define store_one(file_name, object)			\
5301da177e4SLinus Torvalds static ssize_t store_##file_name					\
5311da177e4SLinus Torvalds (struct cpufreq_policy *policy, const char *buf, size_t count)		\
5321da177e4SLinus Torvalds {									\
533619c144cSVince Hsu 	int ret, temp;							\
5341da177e4SLinus Torvalds 	struct cpufreq_policy new_policy;				\
5351da177e4SLinus Torvalds 									\
5361da177e4SLinus Torvalds 	ret = cpufreq_get_policy(&new_policy, policy->cpu);		\
5371da177e4SLinus Torvalds 	if (ret)							\
5381da177e4SLinus Torvalds 		return -EINVAL;						\
5391da177e4SLinus Torvalds 									\
5401da177e4SLinus Torvalds 	ret = sscanf(buf, "%u", &new_policy.object);			\
5411da177e4SLinus Torvalds 	if (ret != 1)							\
5421da177e4SLinus Torvalds 		return -EINVAL;						\
5431da177e4SLinus Torvalds 									\
544619c144cSVince Hsu 	temp = new_policy.object;					\
545037ce839SViresh Kumar 	ret = cpufreq_set_policy(policy, &new_policy);		\
546619c144cSVince Hsu 	if (!ret)							\
547619c144cSVince Hsu 		policy->user_policy.object = temp;			\
5481da177e4SLinus Torvalds 									\
5491da177e4SLinus Torvalds 	return ret ? ret : count;					\
5501da177e4SLinus Torvalds }
5511da177e4SLinus Torvalds 
5521da177e4SLinus Torvalds store_one(scaling_min_freq, min);
5531da177e4SLinus Torvalds store_one(scaling_max_freq, max);
5541da177e4SLinus Torvalds 
5551da177e4SLinus Torvalds /**
5561da177e4SLinus Torvalds  * show_cpuinfo_cur_freq - current CPU frequency as detected by hardware
5571da177e4SLinus Torvalds  */
558e08f5f5bSGautham R Shenoy static ssize_t show_cpuinfo_cur_freq(struct cpufreq_policy *policy,
559e08f5f5bSGautham R Shenoy 					char *buf)
5601da177e4SLinus Torvalds {
561d92d50a4SViresh Kumar 	unsigned int cur_freq = __cpufreq_get(policy);
5621da177e4SLinus Torvalds 	if (!cur_freq)
5631da177e4SLinus Torvalds 		return sprintf(buf, "<unknown>");
5641da177e4SLinus Torvalds 	return sprintf(buf, "%u\n", cur_freq);
5651da177e4SLinus Torvalds }
5661da177e4SLinus Torvalds 
5671da177e4SLinus Torvalds /**
5681da177e4SLinus Torvalds  * show_scaling_governor - show the current policy for the specified CPU
5691da177e4SLinus Torvalds  */
570905d77cdSDave Jones static ssize_t show_scaling_governor(struct cpufreq_policy *policy, char *buf)
5711da177e4SLinus Torvalds {
5721da177e4SLinus Torvalds 	if (policy->policy == CPUFREQ_POLICY_POWERSAVE)
5731da177e4SLinus Torvalds 		return sprintf(buf, "powersave\n");
5741da177e4SLinus Torvalds 	else if (policy->policy == CPUFREQ_POLICY_PERFORMANCE)
5751da177e4SLinus Torvalds 		return sprintf(buf, "performance\n");
5761da177e4SLinus Torvalds 	else if (policy->governor)
5774b972f0bSviresh kumar 		return scnprintf(buf, CPUFREQ_NAME_PLEN, "%s\n",
57829464f28SDave Jones 				policy->governor->name);
5791da177e4SLinus Torvalds 	return -EINVAL;
5801da177e4SLinus Torvalds }
5811da177e4SLinus Torvalds 
5821da177e4SLinus Torvalds /**
5831da177e4SLinus Torvalds  * store_scaling_governor - store policy for the specified CPU
5841da177e4SLinus Torvalds  */
5851da177e4SLinus Torvalds static ssize_t store_scaling_governor(struct cpufreq_policy *policy,
5861da177e4SLinus Torvalds 					const char *buf, size_t count)
5871da177e4SLinus Torvalds {
5885136fa56SSrivatsa S. Bhat 	int ret;
5891da177e4SLinus Torvalds 	char	str_governor[16];
5901da177e4SLinus Torvalds 	struct cpufreq_policy new_policy;
5911da177e4SLinus Torvalds 
5921da177e4SLinus Torvalds 	ret = cpufreq_get_policy(&new_policy, policy->cpu);
5931da177e4SLinus Torvalds 	if (ret)
5941da177e4SLinus Torvalds 		return ret;
5951da177e4SLinus Torvalds 
5961da177e4SLinus Torvalds 	ret = sscanf(buf, "%15s", str_governor);
5971da177e4SLinus Torvalds 	if (ret != 1)
5981da177e4SLinus Torvalds 		return -EINVAL;
5991da177e4SLinus Torvalds 
600e08f5f5bSGautham R Shenoy 	if (cpufreq_parse_governor(str_governor, &new_policy.policy,
601e08f5f5bSGautham R Shenoy 						&new_policy.governor))
6021da177e4SLinus Torvalds 		return -EINVAL;
6031da177e4SLinus Torvalds 
604037ce839SViresh Kumar 	ret = cpufreq_set_policy(policy, &new_policy);
6057970e08bSThomas Renninger 
6067970e08bSThomas Renninger 	policy->user_policy.policy = policy->policy;
6077970e08bSThomas Renninger 	policy->user_policy.governor = policy->governor;
6087970e08bSThomas Renninger 
609e08f5f5bSGautham R Shenoy 	if (ret)
610e08f5f5bSGautham R Shenoy 		return ret;
611e08f5f5bSGautham R Shenoy 	else
612e08f5f5bSGautham R Shenoy 		return count;
6131da177e4SLinus Torvalds }
6141da177e4SLinus Torvalds 
6151da177e4SLinus Torvalds /**
6161da177e4SLinus Torvalds  * show_scaling_driver - show the cpufreq driver currently loaded
6171da177e4SLinus Torvalds  */
6181da177e4SLinus Torvalds static ssize_t show_scaling_driver(struct cpufreq_policy *policy, char *buf)
6191da177e4SLinus Torvalds {
6201c3d85ddSRafael J. Wysocki 	return scnprintf(buf, CPUFREQ_NAME_PLEN, "%s\n", cpufreq_driver->name);
6211da177e4SLinus Torvalds }
6221da177e4SLinus Torvalds 
6231da177e4SLinus Torvalds /**
6241da177e4SLinus Torvalds  * show_scaling_available_governors - show the available CPUfreq governors
6251da177e4SLinus Torvalds  */
6261da177e4SLinus Torvalds static ssize_t show_scaling_available_governors(struct cpufreq_policy *policy,
6271da177e4SLinus Torvalds 						char *buf)
6281da177e4SLinus Torvalds {
6291da177e4SLinus Torvalds 	ssize_t i = 0;
6301da177e4SLinus Torvalds 	struct cpufreq_governor *t;
6311da177e4SLinus Torvalds 
6329c0ebcf7SViresh Kumar 	if (!has_target()) {
6331da177e4SLinus Torvalds 		i += sprintf(buf, "performance powersave");
6341da177e4SLinus Torvalds 		goto out;
6351da177e4SLinus Torvalds 	}
6361da177e4SLinus Torvalds 
6371da177e4SLinus Torvalds 	list_for_each_entry(t, &cpufreq_governor_list, governor_list) {
63829464f28SDave Jones 		if (i >= (ssize_t) ((PAGE_SIZE / sizeof(char))
63929464f28SDave Jones 		    - (CPUFREQ_NAME_LEN + 2)))
6401da177e4SLinus Torvalds 			goto out;
6414b972f0bSviresh kumar 		i += scnprintf(&buf[i], CPUFREQ_NAME_PLEN, "%s ", t->name);
6421da177e4SLinus Torvalds 	}
6431da177e4SLinus Torvalds out:
6441da177e4SLinus Torvalds 	i += sprintf(&buf[i], "\n");
6451da177e4SLinus Torvalds 	return i;
6461da177e4SLinus Torvalds }
647e8628dd0SDarrick J. Wong 
648f4fd3797SLan Tianyu ssize_t cpufreq_show_cpus(const struct cpumask *mask, char *buf)
6491da177e4SLinus Torvalds {
6501da177e4SLinus Torvalds 	ssize_t i = 0;
6511da177e4SLinus Torvalds 	unsigned int cpu;
6521da177e4SLinus Torvalds 
653835481d9SRusty Russell 	for_each_cpu(cpu, mask) {
6541da177e4SLinus Torvalds 		if (i)
6551da177e4SLinus Torvalds 			i += scnprintf(&buf[i], (PAGE_SIZE - i - 2), " ");
6561da177e4SLinus Torvalds 		i += scnprintf(&buf[i], (PAGE_SIZE - i - 2), "%u", cpu);
6571da177e4SLinus Torvalds 		if (i >= (PAGE_SIZE - 5))
6581da177e4SLinus Torvalds 			break;
6591da177e4SLinus Torvalds 	}
6601da177e4SLinus Torvalds 	i += sprintf(&buf[i], "\n");
6611da177e4SLinus Torvalds 	return i;
6621da177e4SLinus Torvalds }
663f4fd3797SLan Tianyu EXPORT_SYMBOL_GPL(cpufreq_show_cpus);
6641da177e4SLinus Torvalds 
665e8628dd0SDarrick J. Wong /**
666e8628dd0SDarrick J. Wong  * show_related_cpus - show the CPUs affected by each transition even if
667e8628dd0SDarrick J. Wong  * hw coordination is in use
668e8628dd0SDarrick J. Wong  */
669e8628dd0SDarrick J. Wong static ssize_t show_related_cpus(struct cpufreq_policy *policy, char *buf)
670e8628dd0SDarrick J. Wong {
671f4fd3797SLan Tianyu 	return cpufreq_show_cpus(policy->related_cpus, buf);
672e8628dd0SDarrick J. Wong }
673e8628dd0SDarrick J. Wong 
674e8628dd0SDarrick J. Wong /**
675e8628dd0SDarrick J. Wong  * show_affected_cpus - show the CPUs affected by each transition
676e8628dd0SDarrick J. Wong  */
677e8628dd0SDarrick J. Wong static ssize_t show_affected_cpus(struct cpufreq_policy *policy, char *buf)
678e8628dd0SDarrick J. Wong {
679f4fd3797SLan Tianyu 	return cpufreq_show_cpus(policy->cpus, buf);
680e8628dd0SDarrick J. Wong }
681e8628dd0SDarrick J. Wong 
6829e76988eSVenki Pallipadi static ssize_t store_scaling_setspeed(struct cpufreq_policy *policy,
6839e76988eSVenki Pallipadi 					const char *buf, size_t count)
6849e76988eSVenki Pallipadi {
6859e76988eSVenki Pallipadi 	unsigned int freq = 0;
6869e76988eSVenki Pallipadi 	unsigned int ret;
6879e76988eSVenki Pallipadi 
688879000f9SCHIKAMA masaki 	if (!policy->governor || !policy->governor->store_setspeed)
6899e76988eSVenki Pallipadi 		return -EINVAL;
6909e76988eSVenki Pallipadi 
6919e76988eSVenki Pallipadi 	ret = sscanf(buf, "%u", &freq);
6929e76988eSVenki Pallipadi 	if (ret != 1)
6939e76988eSVenki Pallipadi 		return -EINVAL;
6949e76988eSVenki Pallipadi 
6959e76988eSVenki Pallipadi 	policy->governor->store_setspeed(policy, freq);
6969e76988eSVenki Pallipadi 
6979e76988eSVenki Pallipadi 	return count;
6989e76988eSVenki Pallipadi }
6999e76988eSVenki Pallipadi 
7009e76988eSVenki Pallipadi static ssize_t show_scaling_setspeed(struct cpufreq_policy *policy, char *buf)
7019e76988eSVenki Pallipadi {
702879000f9SCHIKAMA masaki 	if (!policy->governor || !policy->governor->show_setspeed)
7039e76988eSVenki Pallipadi 		return sprintf(buf, "<unsupported>\n");
7049e76988eSVenki Pallipadi 
7059e76988eSVenki Pallipadi 	return policy->governor->show_setspeed(policy, buf);
7069e76988eSVenki Pallipadi }
7071da177e4SLinus Torvalds 
708e2f74f35SThomas Renninger /**
7098bf1ac72Sviresh kumar  * show_bios_limit - show the current cpufreq HW/BIOS limitation
710e2f74f35SThomas Renninger  */
711e2f74f35SThomas Renninger static ssize_t show_bios_limit(struct cpufreq_policy *policy, char *buf)
712e2f74f35SThomas Renninger {
713e2f74f35SThomas Renninger 	unsigned int limit;
714e2f74f35SThomas Renninger 	int ret;
7151c3d85ddSRafael J. Wysocki 	if (cpufreq_driver->bios_limit) {
7161c3d85ddSRafael J. Wysocki 		ret = cpufreq_driver->bios_limit(policy->cpu, &limit);
717e2f74f35SThomas Renninger 		if (!ret)
718e2f74f35SThomas Renninger 			return sprintf(buf, "%u\n", limit);
719e2f74f35SThomas Renninger 	}
720e2f74f35SThomas Renninger 	return sprintf(buf, "%u\n", policy->cpuinfo.max_freq);
721e2f74f35SThomas Renninger }
722e2f74f35SThomas Renninger 
7236dad2a29SBorislav Petkov cpufreq_freq_attr_ro_perm(cpuinfo_cur_freq, 0400);
7246dad2a29SBorislav Petkov cpufreq_freq_attr_ro(cpuinfo_min_freq);
7256dad2a29SBorislav Petkov cpufreq_freq_attr_ro(cpuinfo_max_freq);
7266dad2a29SBorislav Petkov cpufreq_freq_attr_ro(cpuinfo_transition_latency);
7276dad2a29SBorislav Petkov cpufreq_freq_attr_ro(scaling_available_governors);
7286dad2a29SBorislav Petkov cpufreq_freq_attr_ro(scaling_driver);
7296dad2a29SBorislav Petkov cpufreq_freq_attr_ro(scaling_cur_freq);
7306dad2a29SBorislav Petkov cpufreq_freq_attr_ro(bios_limit);
7316dad2a29SBorislav Petkov cpufreq_freq_attr_ro(related_cpus);
7326dad2a29SBorislav Petkov cpufreq_freq_attr_ro(affected_cpus);
7336dad2a29SBorislav Petkov cpufreq_freq_attr_rw(scaling_min_freq);
7346dad2a29SBorislav Petkov cpufreq_freq_attr_rw(scaling_max_freq);
7356dad2a29SBorislav Petkov cpufreq_freq_attr_rw(scaling_governor);
7366dad2a29SBorislav Petkov cpufreq_freq_attr_rw(scaling_setspeed);
7371da177e4SLinus Torvalds 
7381da177e4SLinus Torvalds static struct attribute *default_attrs[] = {
7391da177e4SLinus Torvalds 	&cpuinfo_min_freq.attr,
7401da177e4SLinus Torvalds 	&cpuinfo_max_freq.attr,
741ed129784SThomas Renninger 	&cpuinfo_transition_latency.attr,
7421da177e4SLinus Torvalds 	&scaling_min_freq.attr,
7431da177e4SLinus Torvalds 	&scaling_max_freq.attr,
7441da177e4SLinus Torvalds 	&affected_cpus.attr,
745e8628dd0SDarrick J. Wong 	&related_cpus.attr,
7461da177e4SLinus Torvalds 	&scaling_governor.attr,
7471da177e4SLinus Torvalds 	&scaling_driver.attr,
7481da177e4SLinus Torvalds 	&scaling_available_governors.attr,
7499e76988eSVenki Pallipadi 	&scaling_setspeed.attr,
7501da177e4SLinus Torvalds 	NULL
7511da177e4SLinus Torvalds };
7521da177e4SLinus Torvalds 
7531da177e4SLinus Torvalds #define to_policy(k) container_of(k, struct cpufreq_policy, kobj)
7541da177e4SLinus Torvalds #define to_attr(a) container_of(a, struct freq_attr, attr)
7551da177e4SLinus Torvalds 
7561da177e4SLinus Torvalds static ssize_t show(struct kobject *kobj, struct attribute *attr, char *buf)
7571da177e4SLinus Torvalds {
7581da177e4SLinus Torvalds 	struct cpufreq_policy *policy = to_policy(kobj);
7591da177e4SLinus Torvalds 	struct freq_attr *fattr = to_attr(attr);
7601b750e3bSViresh Kumar 	ssize_t ret;
7616eed9404SViresh Kumar 
7626eed9404SViresh Kumar 	if (!down_read_trylock(&cpufreq_rwsem))
7631b750e3bSViresh Kumar 		return -EINVAL;
7645a01f2e8SVenkatesh Pallipadi 
765ad7722daSviresh kumar 	down_read(&policy->rwsem);
7665a01f2e8SVenkatesh Pallipadi 
767e08f5f5bSGautham R Shenoy 	if (fattr->show)
768e08f5f5bSGautham R Shenoy 		ret = fattr->show(policy, buf);
769e08f5f5bSGautham R Shenoy 	else
770e08f5f5bSGautham R Shenoy 		ret = -EIO;
771e08f5f5bSGautham R Shenoy 
772ad7722daSviresh kumar 	up_read(&policy->rwsem);
7736eed9404SViresh Kumar 	up_read(&cpufreq_rwsem);
7741b750e3bSViresh Kumar 
7751da177e4SLinus Torvalds 	return ret;
7761da177e4SLinus Torvalds }
7771da177e4SLinus Torvalds 
7781da177e4SLinus Torvalds static ssize_t store(struct kobject *kobj, struct attribute *attr,
7791da177e4SLinus Torvalds 		     const char *buf, size_t count)
7801da177e4SLinus Torvalds {
7811da177e4SLinus Torvalds 	struct cpufreq_policy *policy = to_policy(kobj);
7821da177e4SLinus Torvalds 	struct freq_attr *fattr = to_attr(attr);
783a07530b4SDave Jones 	ssize_t ret = -EINVAL;
7846eed9404SViresh Kumar 
7854f750c93SSrivatsa S. Bhat 	get_online_cpus();
7864f750c93SSrivatsa S. Bhat 
7874f750c93SSrivatsa S. Bhat 	if (!cpu_online(policy->cpu))
7884f750c93SSrivatsa S. Bhat 		goto unlock;
7894f750c93SSrivatsa S. Bhat 
7906eed9404SViresh Kumar 	if (!down_read_trylock(&cpufreq_rwsem))
7914f750c93SSrivatsa S. Bhat 		goto unlock;
7925a01f2e8SVenkatesh Pallipadi 
793ad7722daSviresh kumar 	down_write(&policy->rwsem);
7945a01f2e8SVenkatesh Pallipadi 
795e08f5f5bSGautham R Shenoy 	if (fattr->store)
796e08f5f5bSGautham R Shenoy 		ret = fattr->store(policy, buf, count);
797e08f5f5bSGautham R Shenoy 	else
798e08f5f5bSGautham R Shenoy 		ret = -EIO;
799e08f5f5bSGautham R Shenoy 
800ad7722daSviresh kumar 	up_write(&policy->rwsem);
8016eed9404SViresh Kumar 
8026eed9404SViresh Kumar 	up_read(&cpufreq_rwsem);
8034f750c93SSrivatsa S. Bhat unlock:
8044f750c93SSrivatsa S. Bhat 	put_online_cpus();
8054f750c93SSrivatsa S. Bhat 
8061da177e4SLinus Torvalds 	return ret;
8071da177e4SLinus Torvalds }
8081da177e4SLinus Torvalds 
8091da177e4SLinus Torvalds static void cpufreq_sysfs_release(struct kobject *kobj)
8101da177e4SLinus Torvalds {
8111da177e4SLinus Torvalds 	struct cpufreq_policy *policy = to_policy(kobj);
8122d06d8c4SDominik Brodowski 	pr_debug("last reference is dropped\n");
8131da177e4SLinus Torvalds 	complete(&policy->kobj_unregister);
8141da177e4SLinus Torvalds }
8151da177e4SLinus Torvalds 
81652cf25d0SEmese Revfy static const struct sysfs_ops sysfs_ops = {
8171da177e4SLinus Torvalds 	.show	= show,
8181da177e4SLinus Torvalds 	.store	= store,
8191da177e4SLinus Torvalds };
8201da177e4SLinus Torvalds 
8211da177e4SLinus Torvalds static struct kobj_type ktype_cpufreq = {
8221da177e4SLinus Torvalds 	.sysfs_ops	= &sysfs_ops,
8231da177e4SLinus Torvalds 	.default_attrs	= default_attrs,
8241da177e4SLinus Torvalds 	.release	= cpufreq_sysfs_release,
8251da177e4SLinus Torvalds };
8261da177e4SLinus Torvalds 
8272361be23SViresh Kumar struct kobject *cpufreq_global_kobject;
8282361be23SViresh Kumar EXPORT_SYMBOL(cpufreq_global_kobject);
8292361be23SViresh Kumar 
8302361be23SViresh Kumar static int cpufreq_global_kobject_usage;
8312361be23SViresh Kumar 
8322361be23SViresh Kumar int cpufreq_get_global_kobject(void)
8332361be23SViresh Kumar {
8342361be23SViresh Kumar 	if (!cpufreq_global_kobject_usage++)
8352361be23SViresh Kumar 		return kobject_add(cpufreq_global_kobject,
8362361be23SViresh Kumar 				&cpu_subsys.dev_root->kobj, "%s", "cpufreq");
8372361be23SViresh Kumar 
8382361be23SViresh Kumar 	return 0;
8392361be23SViresh Kumar }
8402361be23SViresh Kumar EXPORT_SYMBOL(cpufreq_get_global_kobject);
8412361be23SViresh Kumar 
8422361be23SViresh Kumar void cpufreq_put_global_kobject(void)
8432361be23SViresh Kumar {
8442361be23SViresh Kumar 	if (!--cpufreq_global_kobject_usage)
8452361be23SViresh Kumar 		kobject_del(cpufreq_global_kobject);
8462361be23SViresh Kumar }
8472361be23SViresh Kumar EXPORT_SYMBOL(cpufreq_put_global_kobject);
8482361be23SViresh Kumar 
8492361be23SViresh Kumar int cpufreq_sysfs_create_file(const struct attribute *attr)
8502361be23SViresh Kumar {
8512361be23SViresh Kumar 	int ret = cpufreq_get_global_kobject();
8522361be23SViresh Kumar 
8532361be23SViresh Kumar 	if (!ret) {
8542361be23SViresh Kumar 		ret = sysfs_create_file(cpufreq_global_kobject, attr);
8552361be23SViresh Kumar 		if (ret)
8562361be23SViresh Kumar 			cpufreq_put_global_kobject();
8572361be23SViresh Kumar 	}
8582361be23SViresh Kumar 
8592361be23SViresh Kumar 	return ret;
8602361be23SViresh Kumar }
8612361be23SViresh Kumar EXPORT_SYMBOL(cpufreq_sysfs_create_file);
8622361be23SViresh Kumar 
8632361be23SViresh Kumar void cpufreq_sysfs_remove_file(const struct attribute *attr)
8642361be23SViresh Kumar {
8652361be23SViresh Kumar 	sysfs_remove_file(cpufreq_global_kobject, attr);
8662361be23SViresh Kumar 	cpufreq_put_global_kobject();
8672361be23SViresh Kumar }
8682361be23SViresh Kumar EXPORT_SYMBOL(cpufreq_sysfs_remove_file);
8692361be23SViresh Kumar 
87019d6f7ecSDave Jones /* symlink affected CPUs */
871308b60e7SViresh Kumar static int cpufreq_add_dev_symlink(struct cpufreq_policy *policy)
87219d6f7ecSDave Jones {
87319d6f7ecSDave Jones 	unsigned int j;
87419d6f7ecSDave Jones 	int ret = 0;
87519d6f7ecSDave Jones 
87619d6f7ecSDave Jones 	for_each_cpu(j, policy->cpus) {
8778a25a2fdSKay Sievers 		struct device *cpu_dev;
87819d6f7ecSDave Jones 
879308b60e7SViresh Kumar 		if (j == policy->cpu)
88019d6f7ecSDave Jones 			continue;
88119d6f7ecSDave Jones 
882e8fdde10SViresh Kumar 		pr_debug("Adding link for CPU: %u\n", j);
8838a25a2fdSKay Sievers 		cpu_dev = get_cpu_device(j);
8848a25a2fdSKay Sievers 		ret = sysfs_create_link(&cpu_dev->kobj, &policy->kobj,
88519d6f7ecSDave Jones 					"cpufreq");
88671c3461eSRafael J. Wysocki 		if (ret)
88771c3461eSRafael J. Wysocki 			break;
88819d6f7ecSDave Jones 	}
88919d6f7ecSDave Jones 	return ret;
89019d6f7ecSDave Jones }
89119d6f7ecSDave Jones 
892308b60e7SViresh Kumar static int cpufreq_add_dev_interface(struct cpufreq_policy *policy,
8938a25a2fdSKay Sievers 				     struct device *dev)
894909a694eSDave Jones {
895909a694eSDave Jones 	struct freq_attr **drv_attr;
896909a694eSDave Jones 	int ret = 0;
897909a694eSDave Jones 
898909a694eSDave Jones 	/* set up files for this cpu device */
8991c3d85ddSRafael J. Wysocki 	drv_attr = cpufreq_driver->attr;
900f13f1184SViresh Kumar 	while (drv_attr && *drv_attr) {
901909a694eSDave Jones 		ret = sysfs_create_file(&policy->kobj, &((*drv_attr)->attr));
902909a694eSDave Jones 		if (ret)
9036d4e81edSTomeu Vizoso 			return ret;
904909a694eSDave Jones 		drv_attr++;
905909a694eSDave Jones 	}
9061c3d85ddSRafael J. Wysocki 	if (cpufreq_driver->get) {
907909a694eSDave Jones 		ret = sysfs_create_file(&policy->kobj, &cpuinfo_cur_freq.attr);
908909a694eSDave Jones 		if (ret)
9096d4e81edSTomeu Vizoso 			return ret;
910909a694eSDave Jones 	}
911c034b02eSDirk Brandewie 
912909a694eSDave Jones 	ret = sysfs_create_file(&policy->kobj, &scaling_cur_freq.attr);
913909a694eSDave Jones 	if (ret)
9146d4e81edSTomeu Vizoso 		return ret;
915c034b02eSDirk Brandewie 
9161c3d85ddSRafael J. Wysocki 	if (cpufreq_driver->bios_limit) {
917e2f74f35SThomas Renninger 		ret = sysfs_create_file(&policy->kobj, &bios_limit.attr);
918e2f74f35SThomas Renninger 		if (ret)
9196d4e81edSTomeu Vizoso 			return ret;
920e2f74f35SThomas Renninger 	}
921909a694eSDave Jones 
9226d4e81edSTomeu Vizoso 	return cpufreq_add_dev_symlink(policy);
923e18f1682SSrivatsa S. Bhat }
924e18f1682SSrivatsa S. Bhat 
925e18f1682SSrivatsa S. Bhat static void cpufreq_init_policy(struct cpufreq_policy *policy)
926e18f1682SSrivatsa S. Bhat {
9276e2c89d1Sviresh kumar 	struct cpufreq_governor *gov = NULL;
928e18f1682SSrivatsa S. Bhat 	struct cpufreq_policy new_policy;
929e18f1682SSrivatsa S. Bhat 	int ret = 0;
930e18f1682SSrivatsa S. Bhat 
931d5b73cd8SViresh Kumar 	memcpy(&new_policy, policy, sizeof(*policy));
932a27a9ab7SJason Baron 
9336e2c89d1Sviresh kumar 	/* Update governor of new_policy to the governor used before hotplug */
93442f91fa1SViresh Kumar 	gov = find_governor(per_cpu(cpufreq_cpu_governor, policy->cpu));
9356e2c89d1Sviresh kumar 	if (gov)
9366e2c89d1Sviresh kumar 		pr_debug("Restoring governor %s for cpu %d\n",
9376e2c89d1Sviresh kumar 				policy->governor->name, policy->cpu);
9386e2c89d1Sviresh kumar 	else
9396e2c89d1Sviresh kumar 		gov = CPUFREQ_DEFAULT_GOVERNOR;
9406e2c89d1Sviresh kumar 
9416e2c89d1Sviresh kumar 	new_policy.governor = gov;
9426e2c89d1Sviresh kumar 
943a27a9ab7SJason Baron 	/* Use the default policy if its valid. */
944a27a9ab7SJason Baron 	if (cpufreq_driver->setpolicy)
9456e2c89d1Sviresh kumar 		cpufreq_parse_governor(gov->name, &new_policy.policy, NULL);
946ecf7e461SDave Jones 
947ecf7e461SDave Jones 	/* set default policy */
948037ce839SViresh Kumar 	ret = cpufreq_set_policy(policy, &new_policy);
949ecf7e461SDave Jones 	if (ret) {
9502d06d8c4SDominik Brodowski 		pr_debug("setting policy failed\n");
9511c3d85ddSRafael J. Wysocki 		if (cpufreq_driver->exit)
9521c3d85ddSRafael J. Wysocki 			cpufreq_driver->exit(policy);
953ecf7e461SDave Jones 	}
954909a694eSDave Jones }
955909a694eSDave Jones 
956d8d3b471SViresh Kumar static int cpufreq_add_policy_cpu(struct cpufreq_policy *policy,
95742f921a6SViresh Kumar 				  unsigned int cpu, struct device *dev)
958fcf80582SViresh Kumar {
9599c0ebcf7SViresh Kumar 	int ret = 0;
960fcf80582SViresh Kumar 	unsigned long flags;
961fcf80582SViresh Kumar 
9629c0ebcf7SViresh Kumar 	if (has_target()) {
9633de9bdebSViresh Kumar 		ret = __cpufreq_governor(policy, CPUFREQ_GOV_STOP);
9643de9bdebSViresh Kumar 		if (ret) {
9653de9bdebSViresh Kumar 			pr_err("%s: Failed to stop governor\n", __func__);
9663de9bdebSViresh Kumar 			return ret;
9673de9bdebSViresh Kumar 		}
9683de9bdebSViresh Kumar 	}
969fcf80582SViresh Kumar 
970ad7722daSviresh kumar 	down_write(&policy->rwsem);
9712eaa3e2dSViresh Kumar 
9720d1857a1SNathan Zimmer 	write_lock_irqsave(&cpufreq_driver_lock, flags);
9732eaa3e2dSViresh Kumar 
974fcf80582SViresh Kumar 	cpumask_set_cpu(cpu, policy->cpus);
975fcf80582SViresh Kumar 	per_cpu(cpufreq_cpu_data, cpu) = policy;
9760d1857a1SNathan Zimmer 	write_unlock_irqrestore(&cpufreq_driver_lock, flags);
977fcf80582SViresh Kumar 
978ad7722daSviresh kumar 	up_write(&policy->rwsem);
9792eaa3e2dSViresh Kumar 
9809c0ebcf7SViresh Kumar 	if (has_target()) {
981e5c87b76SStratos Karafotis 		ret = __cpufreq_governor(policy, CPUFREQ_GOV_START);
982e5c87b76SStratos Karafotis 		if (!ret)
983e5c87b76SStratos Karafotis 			ret = __cpufreq_governor(policy, CPUFREQ_GOV_LIMITS);
984e5c87b76SStratos Karafotis 
985e5c87b76SStratos Karafotis 		if (ret) {
9863de9bdebSViresh Kumar 			pr_err("%s: Failed to start governor\n", __func__);
9873de9bdebSViresh Kumar 			return ret;
9883de9bdebSViresh Kumar 		}
989820c6ca2SViresh Kumar 	}
990fcf80582SViresh Kumar 
99142f921a6SViresh Kumar 	return sysfs_create_link(&dev->kobj, &policy->kobj, "cpufreq");
992fcf80582SViresh Kumar }
9931da177e4SLinus Torvalds 
9948414809cSSrivatsa S. Bhat static struct cpufreq_policy *cpufreq_policy_restore(unsigned int cpu)
9958414809cSSrivatsa S. Bhat {
9968414809cSSrivatsa S. Bhat 	struct cpufreq_policy *policy;
9978414809cSSrivatsa S. Bhat 	unsigned long flags;
9988414809cSSrivatsa S. Bhat 
99944871c9cSLan Tianyu 	read_lock_irqsave(&cpufreq_driver_lock, flags);
10008414809cSSrivatsa S. Bhat 
10018414809cSSrivatsa S. Bhat 	policy = per_cpu(cpufreq_cpu_data_fallback, cpu);
10028414809cSSrivatsa S. Bhat 
100344871c9cSLan Tianyu 	read_unlock_irqrestore(&cpufreq_driver_lock, flags);
10048414809cSSrivatsa S. Bhat 
100509712f55SGeert Uytterhoeven 	if (policy)
10066e2c89d1Sviresh kumar 		policy->governor = NULL;
10076e2c89d1Sviresh kumar 
10088414809cSSrivatsa S. Bhat 	return policy;
10098414809cSSrivatsa S. Bhat }
10108414809cSSrivatsa S. Bhat 
1011e9698cc5SSrivatsa S. Bhat static struct cpufreq_policy *cpufreq_policy_alloc(void)
1012e9698cc5SSrivatsa S. Bhat {
1013e9698cc5SSrivatsa S. Bhat 	struct cpufreq_policy *policy;
1014e9698cc5SSrivatsa S. Bhat 
1015e9698cc5SSrivatsa S. Bhat 	policy = kzalloc(sizeof(*policy), GFP_KERNEL);
1016e9698cc5SSrivatsa S. Bhat 	if (!policy)
1017e9698cc5SSrivatsa S. Bhat 		return NULL;
1018e9698cc5SSrivatsa S. Bhat 
1019e9698cc5SSrivatsa S. Bhat 	if (!alloc_cpumask_var(&policy->cpus, GFP_KERNEL))
1020e9698cc5SSrivatsa S. Bhat 		goto err_free_policy;
1021e9698cc5SSrivatsa S. Bhat 
1022e9698cc5SSrivatsa S. Bhat 	if (!zalloc_cpumask_var(&policy->related_cpus, GFP_KERNEL))
1023e9698cc5SSrivatsa S. Bhat 		goto err_free_cpumask;
1024e9698cc5SSrivatsa S. Bhat 
1025c88a1f8bSLukasz Majewski 	INIT_LIST_HEAD(&policy->policy_list);
1026ad7722daSviresh kumar 	init_rwsem(&policy->rwsem);
102712478cf0SSrivatsa S. Bhat 	spin_lock_init(&policy->transition_lock);
102812478cf0SSrivatsa S. Bhat 	init_waitqueue_head(&policy->transition_wait);
1029ad7722daSviresh kumar 
1030e9698cc5SSrivatsa S. Bhat 	return policy;
1031e9698cc5SSrivatsa S. Bhat 
1032e9698cc5SSrivatsa S. Bhat err_free_cpumask:
1033e9698cc5SSrivatsa S. Bhat 	free_cpumask_var(policy->cpus);
1034e9698cc5SSrivatsa S. Bhat err_free_policy:
1035e9698cc5SSrivatsa S. Bhat 	kfree(policy);
1036e9698cc5SSrivatsa S. Bhat 
1037e9698cc5SSrivatsa S. Bhat 	return NULL;
1038e9698cc5SSrivatsa S. Bhat }
1039e9698cc5SSrivatsa S. Bhat 
104042f921a6SViresh Kumar static void cpufreq_policy_put_kobj(struct cpufreq_policy *policy)
104142f921a6SViresh Kumar {
104242f921a6SViresh Kumar 	struct kobject *kobj;
104342f921a6SViresh Kumar 	struct completion *cmp;
104442f921a6SViresh Kumar 
1045fcd7af91SViresh Kumar 	blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
1046fcd7af91SViresh Kumar 			CPUFREQ_REMOVE_POLICY, policy);
1047fcd7af91SViresh Kumar 
104842f921a6SViresh Kumar 	down_read(&policy->rwsem);
104942f921a6SViresh Kumar 	kobj = &policy->kobj;
105042f921a6SViresh Kumar 	cmp = &policy->kobj_unregister;
105142f921a6SViresh Kumar 	up_read(&policy->rwsem);
105242f921a6SViresh Kumar 	kobject_put(kobj);
105342f921a6SViresh Kumar 
105442f921a6SViresh Kumar 	/*
105542f921a6SViresh Kumar 	 * We need to make sure that the underlying kobj is
105642f921a6SViresh Kumar 	 * actually not referenced anymore by anybody before we
105742f921a6SViresh Kumar 	 * proceed with unloading.
105842f921a6SViresh Kumar 	 */
105942f921a6SViresh Kumar 	pr_debug("waiting for dropping of refcount\n");
106042f921a6SViresh Kumar 	wait_for_completion(cmp);
106142f921a6SViresh Kumar 	pr_debug("wait complete\n");
106242f921a6SViresh Kumar }
106342f921a6SViresh Kumar 
1064e9698cc5SSrivatsa S. Bhat static void cpufreq_policy_free(struct cpufreq_policy *policy)
1065e9698cc5SSrivatsa S. Bhat {
1066e9698cc5SSrivatsa S. Bhat 	free_cpumask_var(policy->related_cpus);
1067e9698cc5SSrivatsa S. Bhat 	free_cpumask_var(policy->cpus);
1068e9698cc5SSrivatsa S. Bhat 	kfree(policy);
1069e9698cc5SSrivatsa S. Bhat }
1070e9698cc5SSrivatsa S. Bhat 
10711bfb425bSViresh Kumar static int update_policy_cpu(struct cpufreq_policy *policy, unsigned int cpu,
10721bfb425bSViresh Kumar 			     struct device *cpu_dev)
10730d66b91eSSrivatsa S. Bhat {
10741bfb425bSViresh Kumar 	int ret;
10751bfb425bSViresh Kumar 
107699ec899eSSrivatsa S. Bhat 	if (WARN_ON(cpu == policy->cpu))
10771bfb425bSViresh Kumar 		return 0;
10781bfb425bSViresh Kumar 
10791bfb425bSViresh Kumar 	/* Move kobject to the new policy->cpu */
10801bfb425bSViresh Kumar 	ret = kobject_move(&policy->kobj, &cpu_dev->kobj);
10811bfb425bSViresh Kumar 	if (ret) {
10821bfb425bSViresh Kumar 		pr_err("%s: Failed to move kobj: %d\n", __func__, ret);
10831bfb425bSViresh Kumar 		return ret;
10841bfb425bSViresh Kumar 	}
1085cb38ed5cSSrivatsa S. Bhat 
1086ad7722daSviresh kumar 	down_write(&policy->rwsem);
10878efd5765SViresh Kumar 
10880d66b91eSSrivatsa S. Bhat 	policy->last_cpu = policy->cpu;
10890d66b91eSSrivatsa S. Bhat 	policy->cpu = cpu;
10900d66b91eSSrivatsa S. Bhat 
1091ad7722daSviresh kumar 	up_write(&policy->rwsem);
10928efd5765SViresh Kumar 
10930d66b91eSSrivatsa S. Bhat 	blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
10940d66b91eSSrivatsa S. Bhat 			CPUFREQ_UPDATE_POLICY_CPU, policy);
10951bfb425bSViresh Kumar 
10961bfb425bSViresh Kumar 	return 0;
10970d66b91eSSrivatsa S. Bhat }
10980d66b91eSSrivatsa S. Bhat 
109996bbbe4aSViresh Kumar static int __cpufreq_add_dev(struct device *dev, struct subsys_interface *sif)
11001da177e4SLinus Torvalds {
1101fcf80582SViresh Kumar 	unsigned int j, cpu = dev->id;
110265922465SViresh Kumar 	int ret = -ENOMEM;
11037f0c020aSViresh Kumar 	struct cpufreq_policy *policy;
11041da177e4SLinus Torvalds 	unsigned long flags;
110596bbbe4aSViresh Kumar 	bool recover_policy = cpufreq_suspended;
11061da177e4SLinus Torvalds 
1107c32b6b8eSAshok Raj 	if (cpu_is_offline(cpu))
1108c32b6b8eSAshok Raj 		return 0;
1109c32b6b8eSAshok Raj 
11102d06d8c4SDominik Brodowski 	pr_debug("adding CPU %u\n", cpu);
11111da177e4SLinus Torvalds 
11121da177e4SLinus Torvalds 	/* check whether a different CPU already registered this
11131da177e4SLinus Torvalds 	 * CPU because it is in the same boat. */
1114d7a9771cSViresh Kumar 	policy = cpufreq_cpu_get_raw(cpu);
1115d7a9771cSViresh Kumar 	if (unlikely(policy))
11161da177e4SLinus Torvalds 		return 0;
1117fcf80582SViresh Kumar 
11186eed9404SViresh Kumar 	if (!down_read_trylock(&cpufreq_rwsem))
11196eed9404SViresh Kumar 		return 0;
11206eed9404SViresh Kumar 
1121fcf80582SViresh Kumar 	/* Check if this cpu was hot-unplugged earlier and has siblings */
11220d1857a1SNathan Zimmer 	read_lock_irqsave(&cpufreq_driver_lock, flags);
11237f0c020aSViresh Kumar 	list_for_each_entry(policy, &cpufreq_policy_list, policy_list) {
11247f0c020aSViresh Kumar 		if (cpumask_test_cpu(cpu, policy->related_cpus)) {
11250d1857a1SNathan Zimmer 			read_unlock_irqrestore(&cpufreq_driver_lock, flags);
11267f0c020aSViresh Kumar 			ret = cpufreq_add_policy_cpu(policy, cpu, dev);
11276eed9404SViresh Kumar 			up_read(&cpufreq_rwsem);
11286eed9404SViresh Kumar 			return ret;
1129fcf80582SViresh Kumar 		}
11302eaa3e2dSViresh Kumar 	}
11310d1857a1SNathan Zimmer 	read_unlock_irqrestore(&cpufreq_driver_lock, flags);
11321da177e4SLinus Torvalds 
113372368d12SRafael J. Wysocki 	/*
113472368d12SRafael J. Wysocki 	 * Restore the saved policy when doing light-weight init and fall back
113572368d12SRafael J. Wysocki 	 * to the full init if that fails.
113672368d12SRafael J. Wysocki 	 */
113796bbbe4aSViresh Kumar 	policy = recover_policy ? cpufreq_policy_restore(cpu) : NULL;
113872368d12SRafael J. Wysocki 	if (!policy) {
113996bbbe4aSViresh Kumar 		recover_policy = false;
1140e9698cc5SSrivatsa S. Bhat 		policy = cpufreq_policy_alloc();
1141059019a3SDave Jones 		if (!policy)
11421da177e4SLinus Torvalds 			goto nomem_out;
114372368d12SRafael J. Wysocki 	}
11440d66b91eSSrivatsa S. Bhat 
11450d66b91eSSrivatsa S. Bhat 	/*
11460d66b91eSSrivatsa S. Bhat 	 * In the resume path, since we restore a saved policy, the assignment
11470d66b91eSSrivatsa S. Bhat 	 * to policy->cpu is like an update of the existing policy, rather than
11480d66b91eSSrivatsa S. Bhat 	 * the creation of a brand new one. So we need to perform this update
11490d66b91eSSrivatsa S. Bhat 	 * by invoking update_policy_cpu().
11500d66b91eSSrivatsa S. Bhat 	 */
11511bfb425bSViresh Kumar 	if (recover_policy && cpu != policy->cpu)
11521bfb425bSViresh Kumar 		WARN_ON(update_policy_cpu(policy, cpu, dev));
11531bfb425bSViresh Kumar 	else
11541da177e4SLinus Torvalds 		policy->cpu = cpu;
11550d66b91eSSrivatsa S. Bhat 
1156835481d9SRusty Russell 	cpumask_copy(policy->cpus, cpumask_of(cpu));
11571da177e4SLinus Torvalds 
11581da177e4SLinus Torvalds 	init_completion(&policy->kobj_unregister);
115965f27f38SDavid Howells 	INIT_WORK(&policy->update, handle_update);
11601da177e4SLinus Torvalds 
11611da177e4SLinus Torvalds 	/* call driver. From then on the cpufreq must be able
11621da177e4SLinus Torvalds 	 * to accept all calls to ->verify and ->setpolicy for this CPU
11631da177e4SLinus Torvalds 	 */
11641c3d85ddSRafael J. Wysocki 	ret = cpufreq_driver->init(policy);
11651da177e4SLinus Torvalds 	if (ret) {
11662d06d8c4SDominik Brodowski 		pr_debug("initialization failed\n");
11672eaa3e2dSViresh Kumar 		goto err_set_policy_cpu;
11681da177e4SLinus Torvalds 	}
1169643ae6e8SViresh Kumar 
11706d4e81edSTomeu Vizoso 	down_write(&policy->rwsem);
11716d4e81edSTomeu Vizoso 
11725a7e56a5SViresh Kumar 	/* related cpus should atleast have policy->cpus */
11735a7e56a5SViresh Kumar 	cpumask_or(policy->related_cpus, policy->related_cpus, policy->cpus);
11745a7e56a5SViresh Kumar 
11755a7e56a5SViresh Kumar 	/*
11765a7e56a5SViresh Kumar 	 * affected cpus must always be the one, which are online. We aren't
11775a7e56a5SViresh Kumar 	 * managing offline cpus here.
11785a7e56a5SViresh Kumar 	 */
11795a7e56a5SViresh Kumar 	cpumask_and(policy->cpus, policy->cpus, cpu_online_mask);
11805a7e56a5SViresh Kumar 
118196bbbe4aSViresh Kumar 	if (!recover_policy) {
11825a7e56a5SViresh Kumar 		policy->user_policy.min = policy->min;
11835a7e56a5SViresh Kumar 		policy->user_policy.max = policy->max;
11846d4e81edSTomeu Vizoso 
11856d4e81edSTomeu Vizoso 		/* prepare interface data */
11866d4e81edSTomeu Vizoso 		ret = kobject_init_and_add(&policy->kobj, &ktype_cpufreq,
11876d4e81edSTomeu Vizoso 					   &dev->kobj, "cpufreq");
11886d4e81edSTomeu Vizoso 		if (ret) {
11896d4e81edSTomeu Vizoso 			pr_err("%s: failed to init policy->kobj: %d\n",
11906d4e81edSTomeu Vizoso 			       __func__, ret);
11916d4e81edSTomeu Vizoso 			goto err_init_policy_kobj;
11926d4e81edSTomeu Vizoso 		}
11935a7e56a5SViresh Kumar 	}
11945a7e56a5SViresh Kumar 
1195652ed95dSViresh Kumar 	write_lock_irqsave(&cpufreq_driver_lock, flags);
1196652ed95dSViresh Kumar 	for_each_cpu(j, policy->cpus)
1197652ed95dSViresh Kumar 		per_cpu(cpufreq_cpu_data, j) = policy;
1198652ed95dSViresh Kumar 	write_unlock_irqrestore(&cpufreq_driver_lock, flags);
1199652ed95dSViresh Kumar 
12002ed99e39SRafael J. Wysocki 	if (cpufreq_driver->get && !cpufreq_driver->setpolicy) {
1201da60ce9fSViresh Kumar 		policy->cur = cpufreq_driver->get(policy->cpu);
1202da60ce9fSViresh Kumar 		if (!policy->cur) {
1203da60ce9fSViresh Kumar 			pr_err("%s: ->get() failed\n", __func__);
1204da60ce9fSViresh Kumar 			goto err_get_freq;
1205da60ce9fSViresh Kumar 		}
1206da60ce9fSViresh Kumar 	}
1207da60ce9fSViresh Kumar 
1208d3916691SViresh Kumar 	/*
1209d3916691SViresh Kumar 	 * Sometimes boot loaders set CPU frequency to a value outside of
1210d3916691SViresh Kumar 	 * frequency table present with cpufreq core. In such cases CPU might be
1211d3916691SViresh Kumar 	 * unstable if it has to run on that frequency for long duration of time
1212d3916691SViresh Kumar 	 * and so its better to set it to a frequency which is specified in
1213d3916691SViresh Kumar 	 * freq-table. This also makes cpufreq stats inconsistent as
1214d3916691SViresh Kumar 	 * cpufreq-stats would fail to register because current frequency of CPU
1215d3916691SViresh Kumar 	 * isn't found in freq-table.
1216d3916691SViresh Kumar 	 *
1217d3916691SViresh Kumar 	 * Because we don't want this change to effect boot process badly, we go
1218d3916691SViresh Kumar 	 * for the next freq which is >= policy->cur ('cur' must be set by now,
1219d3916691SViresh Kumar 	 * otherwise we will end up setting freq to lowest of the table as 'cur'
1220d3916691SViresh Kumar 	 * is initialized to zero).
1221d3916691SViresh Kumar 	 *
1222d3916691SViresh Kumar 	 * We are passing target-freq as "policy->cur - 1" otherwise
1223d3916691SViresh Kumar 	 * __cpufreq_driver_target() would simply fail, as policy->cur will be
1224d3916691SViresh Kumar 	 * equal to target-freq.
1225d3916691SViresh Kumar 	 */
1226d3916691SViresh Kumar 	if ((cpufreq_driver->flags & CPUFREQ_NEED_INITIAL_FREQ_CHECK)
1227d3916691SViresh Kumar 	    && has_target()) {
1228d3916691SViresh Kumar 		/* Are we running at unknown frequency ? */
1229d3916691SViresh Kumar 		ret = cpufreq_frequency_table_get_index(policy, policy->cur);
1230d3916691SViresh Kumar 		if (ret == -EINVAL) {
1231d3916691SViresh Kumar 			/* Warn user and fix it */
1232d3916691SViresh Kumar 			pr_warn("%s: CPU%d: Running at unlisted freq: %u KHz\n",
1233d3916691SViresh Kumar 				__func__, policy->cpu, policy->cur);
1234d3916691SViresh Kumar 			ret = __cpufreq_driver_target(policy, policy->cur - 1,
1235d3916691SViresh Kumar 				CPUFREQ_RELATION_L);
1236d3916691SViresh Kumar 
1237d3916691SViresh Kumar 			/*
1238d3916691SViresh Kumar 			 * Reaching here after boot in a few seconds may not
1239d3916691SViresh Kumar 			 * mean that system will remain stable at "unknown"
1240d3916691SViresh Kumar 			 * frequency for longer duration. Hence, a BUG_ON().
1241d3916691SViresh Kumar 			 */
1242d3916691SViresh Kumar 			BUG_ON(ret);
1243d3916691SViresh Kumar 			pr_warn("%s: CPU%d: Unlisted initial frequency changed to: %u KHz\n",
1244d3916691SViresh Kumar 				__func__, policy->cpu, policy->cur);
1245d3916691SViresh Kumar 		}
1246d3916691SViresh Kumar 	}
1247d3916691SViresh Kumar 
1248a1531acdSThomas Renninger 	blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
1249a1531acdSThomas Renninger 				     CPUFREQ_START, policy);
1250a1531acdSThomas Renninger 
125196bbbe4aSViresh Kumar 	if (!recover_policy) {
1252308b60e7SViresh Kumar 		ret = cpufreq_add_dev_interface(policy, dev);
125319d6f7ecSDave Jones 		if (ret)
12540142f9dcSAhmed S. Darwish 			goto err_out_unregister;
1255fcd7af91SViresh Kumar 		blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
1256fcd7af91SViresh Kumar 				CPUFREQ_CREATE_POLICY, policy);
12579515f4d6SViresh Kumar 	}
1258c88a1f8bSLukasz Majewski 
1259c88a1f8bSLukasz Majewski 	write_lock_irqsave(&cpufreq_driver_lock, flags);
1260c88a1f8bSLukasz Majewski 	list_add(&policy->policy_list, &cpufreq_policy_list);
1261c88a1f8bSLukasz Majewski 	write_unlock_irqrestore(&cpufreq_driver_lock, flags);
12628ff69732SDave Jones 
1263e18f1682SSrivatsa S. Bhat 	cpufreq_init_policy(policy);
1264e18f1682SSrivatsa S. Bhat 
126596bbbe4aSViresh Kumar 	if (!recover_policy) {
126608fd8c1cSViresh Kumar 		policy->user_policy.policy = policy->policy;
126708fd8c1cSViresh Kumar 		policy->user_policy.governor = policy->governor;
126808fd8c1cSViresh Kumar 	}
12694e97b631SViresh Kumar 	up_write(&policy->rwsem);
127008fd8c1cSViresh Kumar 
1271038c5b3eSGreg Kroah-Hartman 	kobject_uevent(&policy->kobj, KOBJ_ADD);
12727c45cf31SViresh Kumar 
12736eed9404SViresh Kumar 	up_read(&cpufreq_rwsem);
12746eed9404SViresh Kumar 
12757c45cf31SViresh Kumar 	/* Callback for handling stuff after policy is ready */
12767c45cf31SViresh Kumar 	if (cpufreq_driver->ready)
12777c45cf31SViresh Kumar 		cpufreq_driver->ready(policy);
12787c45cf31SViresh Kumar 
12792d06d8c4SDominik Brodowski 	pr_debug("initialization complete\n");
12801da177e4SLinus Torvalds 
12811da177e4SLinus Torvalds 	return 0;
12821da177e4SLinus Torvalds 
12831da177e4SLinus Torvalds err_out_unregister:
1284652ed95dSViresh Kumar err_get_freq:
12850d1857a1SNathan Zimmer 	write_lock_irqsave(&cpufreq_driver_lock, flags);
1286474deff7SViresh Kumar 	for_each_cpu(j, policy->cpus)
12877a6aedfaSMike Travis 		per_cpu(cpufreq_cpu_data, j) = NULL;
12880d1857a1SNathan Zimmer 	write_unlock_irqrestore(&cpufreq_driver_lock, flags);
12891da177e4SLinus Torvalds 
12906d4e81edSTomeu Vizoso 	if (!recover_policy) {
12916d4e81edSTomeu Vizoso 		kobject_put(&policy->kobj);
12926d4e81edSTomeu Vizoso 		wait_for_completion(&policy->kobj_unregister);
12936d4e81edSTomeu Vizoso 	}
12946d4e81edSTomeu Vizoso err_init_policy_kobj:
12957106e02bSPrarit Bhargava 	up_write(&policy->rwsem);
12967106e02bSPrarit Bhargava 
1297da60ce9fSViresh Kumar 	if (cpufreq_driver->exit)
1298da60ce9fSViresh Kumar 		cpufreq_driver->exit(policy);
12992eaa3e2dSViresh Kumar err_set_policy_cpu:
130096bbbe4aSViresh Kumar 	if (recover_policy) {
130172368d12SRafael J. Wysocki 		/* Do not leave stale fallback data behind. */
130272368d12SRafael J. Wysocki 		per_cpu(cpufreq_cpu_data_fallback, cpu) = NULL;
130342f921a6SViresh Kumar 		cpufreq_policy_put_kobj(policy);
130472368d12SRafael J. Wysocki 	}
1305e9698cc5SSrivatsa S. Bhat 	cpufreq_policy_free(policy);
130642f921a6SViresh Kumar 
13071da177e4SLinus Torvalds nomem_out:
13086eed9404SViresh Kumar 	up_read(&cpufreq_rwsem);
13096eed9404SViresh Kumar 
13101da177e4SLinus Torvalds 	return ret;
13111da177e4SLinus Torvalds }
13121da177e4SLinus Torvalds 
1313a82fab29SSrivatsa S. Bhat /**
1314a82fab29SSrivatsa S. Bhat  * cpufreq_add_dev - add a CPU device
1315a82fab29SSrivatsa S. Bhat  *
1316a82fab29SSrivatsa S. Bhat  * Adds the cpufreq interface for a CPU device.
1317a82fab29SSrivatsa S. Bhat  *
1318a82fab29SSrivatsa S. Bhat  * The Oracle says: try running cpufreq registration/unregistration concurrently
1319a82fab29SSrivatsa S. Bhat  * with with cpu hotplugging and all hell will break loose. Tried to clean this
1320a82fab29SSrivatsa S. Bhat  * mess up, but more thorough testing is needed. - Mathieu
1321a82fab29SSrivatsa S. Bhat  */
1322a82fab29SSrivatsa S. Bhat static int cpufreq_add_dev(struct device *dev, struct subsys_interface *sif)
1323a82fab29SSrivatsa S. Bhat {
132496bbbe4aSViresh Kumar 	return __cpufreq_add_dev(dev, sif);
1325a82fab29SSrivatsa S. Bhat }
1326a82fab29SSrivatsa S. Bhat 
1327cedb70afSSrivatsa S. Bhat static int __cpufreq_remove_dev_prepare(struct device *dev,
132896bbbe4aSViresh Kumar 					struct subsys_interface *sif)
13291da177e4SLinus Torvalds {
1330f9ba680dSSrivatsa S. Bhat 	unsigned int cpu = dev->id, cpus;
13311bfb425bSViresh Kumar 	int ret;
13321da177e4SLinus Torvalds 	unsigned long flags;
13333a3e9e06SViresh Kumar 	struct cpufreq_policy *policy;
13341da177e4SLinus Torvalds 
1335b8eed8afSViresh Kumar 	pr_debug("%s: unregistering CPU %u\n", __func__, cpu);
13361da177e4SLinus Torvalds 
13370d1857a1SNathan Zimmer 	write_lock_irqsave(&cpufreq_driver_lock, flags);
13381da177e4SLinus Torvalds 
13393a3e9e06SViresh Kumar 	policy = per_cpu(cpufreq_cpu_data, cpu);
13401da177e4SLinus Torvalds 
13418414809cSSrivatsa S. Bhat 	/* Save the policy somewhere when doing a light-weight tear-down */
134296bbbe4aSViresh Kumar 	if (cpufreq_suspended)
13433a3e9e06SViresh Kumar 		per_cpu(cpufreq_cpu_data_fallback, cpu) = policy;
13448414809cSSrivatsa S. Bhat 
13450d1857a1SNathan Zimmer 	write_unlock_irqrestore(&cpufreq_driver_lock, flags);
13461da177e4SLinus Torvalds 
13473a3e9e06SViresh Kumar 	if (!policy) {
1348b8eed8afSViresh Kumar 		pr_debug("%s: No cpu_data found\n", __func__);
13491da177e4SLinus Torvalds 		return -EINVAL;
13501da177e4SLinus Torvalds 	}
13511da177e4SLinus Torvalds 
13529c0ebcf7SViresh Kumar 	if (has_target()) {
13533de9bdebSViresh Kumar 		ret = __cpufreq_governor(policy, CPUFREQ_GOV_STOP);
13543de9bdebSViresh Kumar 		if (ret) {
13553de9bdebSViresh Kumar 			pr_err("%s: Failed to stop governor\n", __func__);
13563de9bdebSViresh Kumar 			return ret;
13573de9bdebSViresh Kumar 		}
13585a01f2e8SVenkatesh Pallipadi 
1359fa69e33fSDirk Brandewie 		strncpy(per_cpu(cpufreq_cpu_governor, cpu),
13603a3e9e06SViresh Kumar 			policy->governor->name, CPUFREQ_NAME_LEN);
1361db5f2995SViresh Kumar 	}
13621da177e4SLinus Torvalds 
1363ad7722daSviresh kumar 	down_read(&policy->rwsem);
13643a3e9e06SViresh Kumar 	cpus = cpumask_weight(policy->cpus);
1365ad7722daSviresh kumar 	up_read(&policy->rwsem);
13661da177e4SLinus Torvalds 
136761173f25SSrivatsa S. Bhat 	if (cpu != policy->cpu) {
136873bf0fc2SViresh Kumar 		sysfs_remove_link(&dev->kobj, "cpufreq");
136973bf0fc2SViresh Kumar 	} else if (cpus > 1) {
13701bfb425bSViresh Kumar 		/* Nominate new CPU */
13711bfb425bSViresh Kumar 		int new_cpu = cpumask_any_but(policy->cpus, cpu);
13721bfb425bSViresh Kumar 		struct device *cpu_dev = get_cpu_device(new_cpu);
13731bfb425bSViresh Kumar 
13741bfb425bSViresh Kumar 		sysfs_remove_link(&cpu_dev->kobj, "cpufreq");
13751bfb425bSViresh Kumar 		ret = update_policy_cpu(policy, new_cpu, cpu_dev);
13761bfb425bSViresh Kumar 		if (ret) {
13771bfb425bSViresh Kumar 			if (sysfs_create_link(&cpu_dev->kobj, &policy->kobj,
13781bfb425bSViresh Kumar 					      "cpufreq"))
13791bfb425bSViresh Kumar 				pr_err("%s: Failed to restore kobj link to cpu:%d\n",
13801bfb425bSViresh Kumar 				       __func__, cpu_dev->id);
13811bfb425bSViresh Kumar 			return ret;
13821bfb425bSViresh Kumar 		}
1383a82fab29SSrivatsa S. Bhat 
1384bda9f552SStratos Karafotis 		if (!cpufreq_suspended)
138575949c9aSViresh Kumar 			pr_debug("%s: policy Kobject moved to cpu: %d from: %d\n",
138675949c9aSViresh Kumar 				 __func__, new_cpu, cpu);
1387789ca243SPreeti U Murthy 	} else if (cpufreq_driver->stop_cpu) {
1388367dc4aaSDirk Brandewie 		cpufreq_driver->stop_cpu(policy);
13891da177e4SLinus Torvalds 	}
1390b8eed8afSViresh Kumar 
1391cedb70afSSrivatsa S. Bhat 	return 0;
1392cedb70afSSrivatsa S. Bhat }
1393cedb70afSSrivatsa S. Bhat 
1394cedb70afSSrivatsa S. Bhat static int __cpufreq_remove_dev_finish(struct device *dev,
139596bbbe4aSViresh Kumar 				       struct subsys_interface *sif)
1396cedb70afSSrivatsa S. Bhat {
1397cedb70afSSrivatsa S. Bhat 	unsigned int cpu = dev->id, cpus;
1398cedb70afSSrivatsa S. Bhat 	int ret;
1399cedb70afSSrivatsa S. Bhat 	unsigned long flags;
1400cedb70afSSrivatsa S. Bhat 	struct cpufreq_policy *policy;
1401cedb70afSSrivatsa S. Bhat 
1402cedb70afSSrivatsa S. Bhat 	read_lock_irqsave(&cpufreq_driver_lock, flags);
1403cedb70afSSrivatsa S. Bhat 	policy = per_cpu(cpufreq_cpu_data, cpu);
1404cedb70afSSrivatsa S. Bhat 	read_unlock_irqrestore(&cpufreq_driver_lock, flags);
1405cedb70afSSrivatsa S. Bhat 
1406cedb70afSSrivatsa S. Bhat 	if (!policy) {
1407cedb70afSSrivatsa S. Bhat 		pr_debug("%s: No cpu_data found\n", __func__);
1408cedb70afSSrivatsa S. Bhat 		return -EINVAL;
1409cedb70afSSrivatsa S. Bhat 	}
1410cedb70afSSrivatsa S. Bhat 
1411ad7722daSviresh kumar 	down_write(&policy->rwsem);
1412cedb70afSSrivatsa S. Bhat 	cpus = cpumask_weight(policy->cpus);
14139c8f1ee4SViresh Kumar 
14149c8f1ee4SViresh Kumar 	if (cpus > 1)
14159c8f1ee4SViresh Kumar 		cpumask_clear_cpu(cpu, policy->cpus);
1416ad7722daSviresh kumar 	up_write(&policy->rwsem);
1417cedb70afSSrivatsa S. Bhat 
1418b8eed8afSViresh Kumar 	/* If cpu is last user of policy, free policy */
1419b8eed8afSViresh Kumar 	if (cpus == 1) {
14209c0ebcf7SViresh Kumar 		if (has_target()) {
14213de9bdebSViresh Kumar 			ret = __cpufreq_governor(policy,
14223de9bdebSViresh Kumar 					CPUFREQ_GOV_POLICY_EXIT);
14233de9bdebSViresh Kumar 			if (ret) {
14243de9bdebSViresh Kumar 				pr_err("%s: Failed to exit governor\n",
14253de9bdebSViresh Kumar 				       __func__);
14263de9bdebSViresh Kumar 				return ret;
14273de9bdebSViresh Kumar 			}
14283de9bdebSViresh Kumar 		}
14292a998599SRafael J. Wysocki 
143096bbbe4aSViresh Kumar 		if (!cpufreq_suspended)
143142f921a6SViresh Kumar 			cpufreq_policy_put_kobj(policy);
14321da177e4SLinus Torvalds 
14338414809cSSrivatsa S. Bhat 		/*
14348414809cSSrivatsa S. Bhat 		 * Perform the ->exit() even during light-weight tear-down,
14358414809cSSrivatsa S. Bhat 		 * since this is a core component, and is essential for the
14368414809cSSrivatsa S. Bhat 		 * subsequent light-weight ->init() to succeed.
14378414809cSSrivatsa S. Bhat 		 */
14381c3d85ddSRafael J. Wysocki 		if (cpufreq_driver->exit)
14393a3e9e06SViresh Kumar 			cpufreq_driver->exit(policy);
144027ecddc2SJacob Shin 
14419515f4d6SViresh Kumar 		/* Remove policy from list of active policies */
14429515f4d6SViresh Kumar 		write_lock_irqsave(&cpufreq_driver_lock, flags);
14439515f4d6SViresh Kumar 		list_del(&policy->policy_list);
14449515f4d6SViresh Kumar 		write_unlock_irqrestore(&cpufreq_driver_lock, flags);
14459515f4d6SViresh Kumar 
144696bbbe4aSViresh Kumar 		if (!cpufreq_suspended)
14473a3e9e06SViresh Kumar 			cpufreq_policy_free(policy);
1448e5c87b76SStratos Karafotis 	} else if (has_target()) {
1449e5c87b76SStratos Karafotis 		ret = __cpufreq_governor(policy, CPUFREQ_GOV_START);
1450e5c87b76SStratos Karafotis 		if (!ret)
1451e5c87b76SStratos Karafotis 			ret = __cpufreq_governor(policy, CPUFREQ_GOV_LIMITS);
1452e5c87b76SStratos Karafotis 
1453e5c87b76SStratos Karafotis 		if (ret) {
1454e5c87b76SStratos Karafotis 			pr_err("%s: Failed to start governor\n", __func__);
14553de9bdebSViresh Kumar 			return ret;
14563de9bdebSViresh Kumar 		}
1457b8eed8afSViresh Kumar 	}
14581da177e4SLinus Torvalds 
1459474deff7SViresh Kumar 	per_cpu(cpufreq_cpu_data, cpu) = NULL;
14601da177e4SLinus Torvalds 	return 0;
14611da177e4SLinus Torvalds }
14621da177e4SLinus Torvalds 
1463cedb70afSSrivatsa S. Bhat /**
146427a862e9SViresh Kumar  * cpufreq_remove_dev - remove a CPU device
1465cedb70afSSrivatsa S. Bhat  *
1466cedb70afSSrivatsa S. Bhat  * Removes the cpufreq interface for a CPU device.
1467cedb70afSSrivatsa S. Bhat  */
14688a25a2fdSKay Sievers static int cpufreq_remove_dev(struct device *dev, struct subsys_interface *sif)
14695a01f2e8SVenkatesh Pallipadi {
14708a25a2fdSKay Sievers 	unsigned int cpu = dev->id;
147127a862e9SViresh Kumar 	int ret;
1472ec28297aSVenki Pallipadi 
1473ec28297aSVenki Pallipadi 	if (cpu_is_offline(cpu))
1474ec28297aSVenki Pallipadi 		return 0;
1475ec28297aSVenki Pallipadi 
147696bbbe4aSViresh Kumar 	ret = __cpufreq_remove_dev_prepare(dev, sif);
147727a862e9SViresh Kumar 
147827a862e9SViresh Kumar 	if (!ret)
147996bbbe4aSViresh Kumar 		ret = __cpufreq_remove_dev_finish(dev, sif);
148027a862e9SViresh Kumar 
148127a862e9SViresh Kumar 	return ret;
14825a01f2e8SVenkatesh Pallipadi }
14835a01f2e8SVenkatesh Pallipadi 
148465f27f38SDavid Howells static void handle_update(struct work_struct *work)
14851da177e4SLinus Torvalds {
148665f27f38SDavid Howells 	struct cpufreq_policy *policy =
148765f27f38SDavid Howells 		container_of(work, struct cpufreq_policy, update);
148865f27f38SDavid Howells 	unsigned int cpu = policy->cpu;
14892d06d8c4SDominik Brodowski 	pr_debug("handle_update for cpu %u called\n", cpu);
14901da177e4SLinus Torvalds 	cpufreq_update_policy(cpu);
14911da177e4SLinus Torvalds }
14921da177e4SLinus Torvalds 
14931da177e4SLinus Torvalds /**
1494bb176f7dSViresh Kumar  *	cpufreq_out_of_sync - If actual and saved CPU frequency differs, we're
1495bb176f7dSViresh Kumar  *	in deep trouble.
1496a1e1dc41SViresh Kumar  *	@policy: policy managing CPUs
14971da177e4SLinus Torvalds  *	@new_freq: CPU frequency the CPU actually runs at
14981da177e4SLinus Torvalds  *
149929464f28SDave Jones  *	We adjust to current frequency first, and need to clean up later.
150029464f28SDave Jones  *	So either call to cpufreq_update_policy() or schedule handle_update()).
15011da177e4SLinus Torvalds  */
1502a1e1dc41SViresh Kumar static void cpufreq_out_of_sync(struct cpufreq_policy *policy,
1503e08f5f5bSGautham R Shenoy 				unsigned int new_freq)
15041da177e4SLinus Torvalds {
15051da177e4SLinus Torvalds 	struct cpufreq_freqs freqs;
1506b43a7ffbSViresh Kumar 
1507e837f9b5SJoe Perches 	pr_debug("Warning: CPU frequency out of sync: cpufreq and timing core thinks of %u, is %u kHz\n",
1508a1e1dc41SViresh Kumar 		 policy->cur, new_freq);
15091da177e4SLinus Torvalds 
1510a1e1dc41SViresh Kumar 	freqs.old = policy->cur;
15111da177e4SLinus Torvalds 	freqs.new = new_freq;
1512b43a7ffbSViresh Kumar 
15138fec051eSViresh Kumar 	cpufreq_freq_transition_begin(policy, &freqs);
15148fec051eSViresh Kumar 	cpufreq_freq_transition_end(policy, &freqs, 0);
15151da177e4SLinus Torvalds }
15161da177e4SLinus Torvalds 
15171da177e4SLinus Torvalds /**
15184ab70df4SDhaval Giani  * cpufreq_quick_get - get the CPU frequency (in kHz) from policy->cur
151995235ca2SVenkatesh Pallipadi  * @cpu: CPU number
152095235ca2SVenkatesh Pallipadi  *
152195235ca2SVenkatesh Pallipadi  * This is the last known freq, without actually getting it from the driver.
152295235ca2SVenkatesh Pallipadi  * Return value will be same as what is shown in scaling_cur_freq in sysfs.
152395235ca2SVenkatesh Pallipadi  */
152495235ca2SVenkatesh Pallipadi unsigned int cpufreq_quick_get(unsigned int cpu)
152595235ca2SVenkatesh Pallipadi {
15269e21ba8bSDirk Brandewie 	struct cpufreq_policy *policy;
1527e08f5f5bSGautham R Shenoy 	unsigned int ret_freq = 0;
152895235ca2SVenkatesh Pallipadi 
15291c3d85ddSRafael J. Wysocki 	if (cpufreq_driver && cpufreq_driver->setpolicy && cpufreq_driver->get)
15301c3d85ddSRafael J. Wysocki 		return cpufreq_driver->get(cpu);
15319e21ba8bSDirk Brandewie 
15329e21ba8bSDirk Brandewie 	policy = cpufreq_cpu_get(cpu);
153395235ca2SVenkatesh Pallipadi 	if (policy) {
1534e08f5f5bSGautham R Shenoy 		ret_freq = policy->cur;
153595235ca2SVenkatesh Pallipadi 		cpufreq_cpu_put(policy);
153695235ca2SVenkatesh Pallipadi 	}
153795235ca2SVenkatesh Pallipadi 
15384d34a67dSDave Jones 	return ret_freq;
153995235ca2SVenkatesh Pallipadi }
154095235ca2SVenkatesh Pallipadi EXPORT_SYMBOL(cpufreq_quick_get);
154195235ca2SVenkatesh Pallipadi 
15423d737108SJesse Barnes /**
15433d737108SJesse Barnes  * cpufreq_quick_get_max - get the max reported CPU frequency for this CPU
15443d737108SJesse Barnes  * @cpu: CPU number
15453d737108SJesse Barnes  *
15463d737108SJesse Barnes  * Just return the max possible frequency for a given CPU.
15473d737108SJesse Barnes  */
15483d737108SJesse Barnes unsigned int cpufreq_quick_get_max(unsigned int cpu)
15493d737108SJesse Barnes {
15503d737108SJesse Barnes 	struct cpufreq_policy *policy = cpufreq_cpu_get(cpu);
15513d737108SJesse Barnes 	unsigned int ret_freq = 0;
15523d737108SJesse Barnes 
15533d737108SJesse Barnes 	if (policy) {
15543d737108SJesse Barnes 		ret_freq = policy->max;
15553d737108SJesse Barnes 		cpufreq_cpu_put(policy);
15563d737108SJesse Barnes 	}
15573d737108SJesse Barnes 
15583d737108SJesse Barnes 	return ret_freq;
15593d737108SJesse Barnes }
15603d737108SJesse Barnes EXPORT_SYMBOL(cpufreq_quick_get_max);
15613d737108SJesse Barnes 
1562d92d50a4SViresh Kumar static unsigned int __cpufreq_get(struct cpufreq_policy *policy)
15631da177e4SLinus Torvalds {
1564e08f5f5bSGautham R Shenoy 	unsigned int ret_freq = 0;
15651da177e4SLinus Torvalds 
15661c3d85ddSRafael J. Wysocki 	if (!cpufreq_driver->get)
15674d34a67dSDave Jones 		return ret_freq;
15681da177e4SLinus Torvalds 
1569d92d50a4SViresh Kumar 	ret_freq = cpufreq_driver->get(policy->cpu);
15701da177e4SLinus Torvalds 
1571e08f5f5bSGautham R Shenoy 	if (ret_freq && policy->cur &&
15721c3d85ddSRafael J. Wysocki 		!(cpufreq_driver->flags & CPUFREQ_CONST_LOOPS)) {
1573e08f5f5bSGautham R Shenoy 		/* verify no discrepancy between actual and
1574e08f5f5bSGautham R Shenoy 					saved value exists */
1575e08f5f5bSGautham R Shenoy 		if (unlikely(ret_freq != policy->cur)) {
1576a1e1dc41SViresh Kumar 			cpufreq_out_of_sync(policy, ret_freq);
15771da177e4SLinus Torvalds 			schedule_work(&policy->update);
15781da177e4SLinus Torvalds 		}
15791da177e4SLinus Torvalds 	}
15801da177e4SLinus Torvalds 
15814d34a67dSDave Jones 	return ret_freq;
15825a01f2e8SVenkatesh Pallipadi }
15831da177e4SLinus Torvalds 
15845a01f2e8SVenkatesh Pallipadi /**
15855a01f2e8SVenkatesh Pallipadi  * cpufreq_get - get the current CPU frequency (in kHz)
15865a01f2e8SVenkatesh Pallipadi  * @cpu: CPU number
15875a01f2e8SVenkatesh Pallipadi  *
15885a01f2e8SVenkatesh Pallipadi  * Get the CPU current (static) CPU frequency
15895a01f2e8SVenkatesh Pallipadi  */
15905a01f2e8SVenkatesh Pallipadi unsigned int cpufreq_get(unsigned int cpu)
15915a01f2e8SVenkatesh Pallipadi {
1592999976e0SAaron Plattner 	struct cpufreq_policy *policy = cpufreq_cpu_get(cpu);
15935a01f2e8SVenkatesh Pallipadi 	unsigned int ret_freq = 0;
15945a01f2e8SVenkatesh Pallipadi 
1595999976e0SAaron Plattner 	if (policy) {
1596ad7722daSviresh kumar 		down_read(&policy->rwsem);
1597d92d50a4SViresh Kumar 		ret_freq = __cpufreq_get(policy);
1598ad7722daSviresh kumar 		up_read(&policy->rwsem);
1599999976e0SAaron Plattner 
1600999976e0SAaron Plattner 		cpufreq_cpu_put(policy);
1601999976e0SAaron Plattner 	}
16026eed9404SViresh Kumar 
16034d34a67dSDave Jones 	return ret_freq;
16041da177e4SLinus Torvalds }
16051da177e4SLinus Torvalds EXPORT_SYMBOL(cpufreq_get);
16061da177e4SLinus Torvalds 
16078a25a2fdSKay Sievers static struct subsys_interface cpufreq_interface = {
16088a25a2fdSKay Sievers 	.name		= "cpufreq",
16098a25a2fdSKay Sievers 	.subsys		= &cpu_subsys,
16108a25a2fdSKay Sievers 	.add_dev	= cpufreq_add_dev,
16118a25a2fdSKay Sievers 	.remove_dev	= cpufreq_remove_dev,
1612e00e56dfSRafael J. Wysocki };
1613e00e56dfSRafael J. Wysocki 
1614e28867eaSViresh Kumar /*
1615e28867eaSViresh Kumar  * In case platform wants some specific frequency to be configured
1616e28867eaSViresh Kumar  * during suspend..
161742d4dc3fSBenjamin Herrenschmidt  */
1618e28867eaSViresh Kumar int cpufreq_generic_suspend(struct cpufreq_policy *policy)
161942d4dc3fSBenjamin Herrenschmidt {
1620e28867eaSViresh Kumar 	int ret;
16214bc5d341SDave Jones 
1622e28867eaSViresh Kumar 	if (!policy->suspend_freq) {
1623e28867eaSViresh Kumar 		pr_err("%s: suspend_freq can't be zero\n", __func__);
1624e28867eaSViresh Kumar 		return -EINVAL;
162542d4dc3fSBenjamin Herrenschmidt 	}
162642d4dc3fSBenjamin Herrenschmidt 
1627e28867eaSViresh Kumar 	pr_debug("%s: Setting suspend-freq: %u\n", __func__,
1628e28867eaSViresh Kumar 			policy->suspend_freq);
1629e28867eaSViresh Kumar 
1630e28867eaSViresh Kumar 	ret = __cpufreq_driver_target(policy, policy->suspend_freq,
1631e28867eaSViresh Kumar 			CPUFREQ_RELATION_H);
1632e28867eaSViresh Kumar 	if (ret)
1633e28867eaSViresh Kumar 		pr_err("%s: unable to set suspend-freq: %u. err: %d\n",
1634e28867eaSViresh Kumar 				__func__, policy->suspend_freq, ret);
1635e28867eaSViresh Kumar 
1636c9060494SDave Jones 	return ret;
163742d4dc3fSBenjamin Herrenschmidt }
1638e28867eaSViresh Kumar EXPORT_SYMBOL(cpufreq_generic_suspend);
163942d4dc3fSBenjamin Herrenschmidt 
164042d4dc3fSBenjamin Herrenschmidt /**
16412f0aea93SViresh Kumar  * cpufreq_suspend() - Suspend CPUFreq governors
16421da177e4SLinus Torvalds  *
16432f0aea93SViresh Kumar  * Called during system wide Suspend/Hibernate cycles for suspending governors
16442f0aea93SViresh Kumar  * as some platforms can't change frequency after this point in suspend cycle.
16452f0aea93SViresh Kumar  * Because some of the devices (like: i2c, regulators, etc) they use for
16462f0aea93SViresh Kumar  * changing frequency are suspended quickly after this point.
16471da177e4SLinus Torvalds  */
16482f0aea93SViresh Kumar void cpufreq_suspend(void)
16491da177e4SLinus Torvalds {
16503a3e9e06SViresh Kumar 	struct cpufreq_policy *policy;
16511da177e4SLinus Torvalds 
16522f0aea93SViresh Kumar 	if (!cpufreq_driver)
1653e00e56dfSRafael J. Wysocki 		return;
16541da177e4SLinus Torvalds 
16552f0aea93SViresh Kumar 	if (!has_target())
1656b1b12babSViresh Kumar 		goto suspend;
16571da177e4SLinus Torvalds 
16582f0aea93SViresh Kumar 	pr_debug("%s: Suspending Governors\n", __func__);
16592f0aea93SViresh Kumar 
16602f0aea93SViresh Kumar 	list_for_each_entry(policy, &cpufreq_policy_list, policy_list) {
16612f0aea93SViresh Kumar 		if (__cpufreq_governor(policy, CPUFREQ_GOV_STOP))
16622f0aea93SViresh Kumar 			pr_err("%s: Failed to stop governor for policy: %p\n",
16632f0aea93SViresh Kumar 				__func__, policy);
16642f0aea93SViresh Kumar 		else if (cpufreq_driver->suspend
16652f0aea93SViresh Kumar 		    && cpufreq_driver->suspend(policy))
16662f0aea93SViresh Kumar 			pr_err("%s: Failed to suspend driver: %p\n", __func__,
16672f0aea93SViresh Kumar 				policy);
16681da177e4SLinus Torvalds 	}
1669b1b12babSViresh Kumar 
1670b1b12babSViresh Kumar suspend:
1671b1b12babSViresh Kumar 	cpufreq_suspended = true;
16721da177e4SLinus Torvalds }
16731da177e4SLinus Torvalds 
16741da177e4SLinus Torvalds /**
16752f0aea93SViresh Kumar  * cpufreq_resume() - Resume CPUFreq governors
16761da177e4SLinus Torvalds  *
16772f0aea93SViresh Kumar  * Called during system wide Suspend/Hibernate cycle for resuming governors that
16782f0aea93SViresh Kumar  * are suspended with cpufreq_suspend().
16791da177e4SLinus Torvalds  */
16802f0aea93SViresh Kumar void cpufreq_resume(void)
16811da177e4SLinus Torvalds {
16821da177e4SLinus Torvalds 	struct cpufreq_policy *policy;
16831da177e4SLinus Torvalds 
16842f0aea93SViresh Kumar 	if (!cpufreq_driver)
16851da177e4SLinus Torvalds 		return;
16861da177e4SLinus Torvalds 
16878e30444eSLan Tianyu 	cpufreq_suspended = false;
16888e30444eSLan Tianyu 
16892f0aea93SViresh Kumar 	if (!has_target())
16902f0aea93SViresh Kumar 		return;
16911da177e4SLinus Torvalds 
16922f0aea93SViresh Kumar 	pr_debug("%s: Resuming Governors\n", __func__);
16932f0aea93SViresh Kumar 
16942f0aea93SViresh Kumar 	list_for_each_entry(policy, &cpufreq_policy_list, policy_list) {
16950c5aa405SViresh Kumar 		if (cpufreq_driver->resume && cpufreq_driver->resume(policy))
16960c5aa405SViresh Kumar 			pr_err("%s: Failed to resume driver: %p\n", __func__,
16970c5aa405SViresh Kumar 				policy);
16980c5aa405SViresh Kumar 		else if (__cpufreq_governor(policy, CPUFREQ_GOV_START)
16992f0aea93SViresh Kumar 		    || __cpufreq_governor(policy, CPUFREQ_GOV_LIMITS))
17002f0aea93SViresh Kumar 			pr_err("%s: Failed to start governor for policy: %p\n",
17012f0aea93SViresh Kumar 				__func__, policy);
17022f0aea93SViresh Kumar 
17032f0aea93SViresh Kumar 		/*
17042f0aea93SViresh Kumar 		 * schedule call cpufreq_update_policy() for boot CPU, i.e. last
17052f0aea93SViresh Kumar 		 * policy in list. It will verify that the current freq is in
17062f0aea93SViresh Kumar 		 * sync with what we believe it to be.
17072f0aea93SViresh Kumar 		 */
17082f0aea93SViresh Kumar 		if (list_is_last(&policy->policy_list, &cpufreq_policy_list))
17093a3e9e06SViresh Kumar 			schedule_work(&policy->update);
17101da177e4SLinus Torvalds 	}
17112f0aea93SViresh Kumar }
17121da177e4SLinus Torvalds 
17139d95046eSBorislav Petkov /**
17149d95046eSBorislav Petkov  *	cpufreq_get_current_driver - return current driver's name
17159d95046eSBorislav Petkov  *
17169d95046eSBorislav Petkov  *	Return the name string of the currently loaded cpufreq driver
17179d95046eSBorislav Petkov  *	or NULL, if none.
17189d95046eSBorislav Petkov  */
17199d95046eSBorislav Petkov const char *cpufreq_get_current_driver(void)
17209d95046eSBorislav Petkov {
17211c3d85ddSRafael J. Wysocki 	if (cpufreq_driver)
17221c3d85ddSRafael J. Wysocki 		return cpufreq_driver->name;
17231c3d85ddSRafael J. Wysocki 
17241c3d85ddSRafael J. Wysocki 	return NULL;
17259d95046eSBorislav Petkov }
17269d95046eSBorislav Petkov EXPORT_SYMBOL_GPL(cpufreq_get_current_driver);
17271da177e4SLinus Torvalds 
172851315cdfSThomas Petazzoni /**
172951315cdfSThomas Petazzoni  *	cpufreq_get_driver_data - return current driver data
173051315cdfSThomas Petazzoni  *
173151315cdfSThomas Petazzoni  *	Return the private data of the currently loaded cpufreq
173251315cdfSThomas Petazzoni  *	driver, or NULL if no cpufreq driver is loaded.
173351315cdfSThomas Petazzoni  */
173451315cdfSThomas Petazzoni void *cpufreq_get_driver_data(void)
173551315cdfSThomas Petazzoni {
173651315cdfSThomas Petazzoni 	if (cpufreq_driver)
173751315cdfSThomas Petazzoni 		return cpufreq_driver->driver_data;
173851315cdfSThomas Petazzoni 
173951315cdfSThomas Petazzoni 	return NULL;
174051315cdfSThomas Petazzoni }
174151315cdfSThomas Petazzoni EXPORT_SYMBOL_GPL(cpufreq_get_driver_data);
174251315cdfSThomas Petazzoni 
17431da177e4SLinus Torvalds /*********************************************************************
17441da177e4SLinus Torvalds  *                     NOTIFIER LISTS INTERFACE                      *
17451da177e4SLinus Torvalds  *********************************************************************/
17461da177e4SLinus Torvalds 
17471da177e4SLinus Torvalds /**
17481da177e4SLinus Torvalds  *	cpufreq_register_notifier - register a driver with cpufreq
17491da177e4SLinus Torvalds  *	@nb: notifier function to register
17501da177e4SLinus Torvalds  *      @list: CPUFREQ_TRANSITION_NOTIFIER or CPUFREQ_POLICY_NOTIFIER
17511da177e4SLinus Torvalds  *
17521da177e4SLinus Torvalds  *	Add a driver to one of two lists: either a list of drivers that
17531da177e4SLinus Torvalds  *      are notified about clock rate changes (once before and once after
17541da177e4SLinus Torvalds  *      the transition), or a list of drivers that are notified about
17551da177e4SLinus Torvalds  *      changes in cpufreq policy.
17561da177e4SLinus Torvalds  *
17571da177e4SLinus Torvalds  *	This function may sleep, and has the same return conditions as
1758e041c683SAlan Stern  *	blocking_notifier_chain_register.
17591da177e4SLinus Torvalds  */
17601da177e4SLinus Torvalds int cpufreq_register_notifier(struct notifier_block *nb, unsigned int list)
17611da177e4SLinus Torvalds {
17621da177e4SLinus Torvalds 	int ret;
17631da177e4SLinus Torvalds 
1764d5aaffa9SDirk Brandewie 	if (cpufreq_disabled())
1765d5aaffa9SDirk Brandewie 		return -EINVAL;
1766d5aaffa9SDirk Brandewie 
176774212ca4SCesar Eduardo Barros 	WARN_ON(!init_cpufreq_transition_notifier_list_called);
176874212ca4SCesar Eduardo Barros 
17691da177e4SLinus Torvalds 	switch (list) {
17701da177e4SLinus Torvalds 	case CPUFREQ_TRANSITION_NOTIFIER:
1771b4dfdbb3SAlan Stern 		ret = srcu_notifier_chain_register(
1772e041c683SAlan Stern 				&cpufreq_transition_notifier_list, nb);
17731da177e4SLinus Torvalds 		break;
17741da177e4SLinus Torvalds 	case CPUFREQ_POLICY_NOTIFIER:
1775e041c683SAlan Stern 		ret = blocking_notifier_chain_register(
1776e041c683SAlan Stern 				&cpufreq_policy_notifier_list, nb);
17771da177e4SLinus Torvalds 		break;
17781da177e4SLinus Torvalds 	default:
17791da177e4SLinus Torvalds 		ret = -EINVAL;
17801da177e4SLinus Torvalds 	}
17811da177e4SLinus Torvalds 
17821da177e4SLinus Torvalds 	return ret;
17831da177e4SLinus Torvalds }
17841da177e4SLinus Torvalds EXPORT_SYMBOL(cpufreq_register_notifier);
17851da177e4SLinus Torvalds 
17861da177e4SLinus Torvalds /**
17871da177e4SLinus Torvalds  *	cpufreq_unregister_notifier - unregister a driver with cpufreq
17881da177e4SLinus Torvalds  *	@nb: notifier block to be unregistered
17891da177e4SLinus Torvalds  *	@list: CPUFREQ_TRANSITION_NOTIFIER or CPUFREQ_POLICY_NOTIFIER
17901da177e4SLinus Torvalds  *
17911da177e4SLinus Torvalds  *	Remove a driver from the CPU frequency notifier list.
17921da177e4SLinus Torvalds  *
17931da177e4SLinus Torvalds  *	This function may sleep, and has the same return conditions as
1794e041c683SAlan Stern  *	blocking_notifier_chain_unregister.
17951da177e4SLinus Torvalds  */
17961da177e4SLinus Torvalds int cpufreq_unregister_notifier(struct notifier_block *nb, unsigned int list)
17971da177e4SLinus Torvalds {
17981da177e4SLinus Torvalds 	int ret;
17991da177e4SLinus Torvalds 
1800d5aaffa9SDirk Brandewie 	if (cpufreq_disabled())
1801d5aaffa9SDirk Brandewie 		return -EINVAL;
1802d5aaffa9SDirk Brandewie 
18031da177e4SLinus Torvalds 	switch (list) {
18041da177e4SLinus Torvalds 	case CPUFREQ_TRANSITION_NOTIFIER:
1805b4dfdbb3SAlan Stern 		ret = srcu_notifier_chain_unregister(
1806e041c683SAlan Stern 				&cpufreq_transition_notifier_list, nb);
18071da177e4SLinus Torvalds 		break;
18081da177e4SLinus Torvalds 	case CPUFREQ_POLICY_NOTIFIER:
1809e041c683SAlan Stern 		ret = blocking_notifier_chain_unregister(
1810e041c683SAlan Stern 				&cpufreq_policy_notifier_list, nb);
18111da177e4SLinus Torvalds 		break;
18121da177e4SLinus Torvalds 	default:
18131da177e4SLinus Torvalds 		ret = -EINVAL;
18141da177e4SLinus Torvalds 	}
18151da177e4SLinus Torvalds 
18161da177e4SLinus Torvalds 	return ret;
18171da177e4SLinus Torvalds }
18181da177e4SLinus Torvalds EXPORT_SYMBOL(cpufreq_unregister_notifier);
18191da177e4SLinus Torvalds 
18201da177e4SLinus Torvalds 
18211da177e4SLinus Torvalds /*********************************************************************
18221da177e4SLinus Torvalds  *                              GOVERNORS                            *
18231da177e4SLinus Torvalds  *********************************************************************/
18241da177e4SLinus Torvalds 
18251c03a2d0SViresh Kumar /* Must set freqs->new to intermediate frequency */
18261c03a2d0SViresh Kumar static int __target_intermediate(struct cpufreq_policy *policy,
18271c03a2d0SViresh Kumar 				 struct cpufreq_freqs *freqs, int index)
18281c03a2d0SViresh Kumar {
18291c03a2d0SViresh Kumar 	int ret;
18301c03a2d0SViresh Kumar 
18311c03a2d0SViresh Kumar 	freqs->new = cpufreq_driver->get_intermediate(policy, index);
18321c03a2d0SViresh Kumar 
18331c03a2d0SViresh Kumar 	/* We don't need to switch to intermediate freq */
18341c03a2d0SViresh Kumar 	if (!freqs->new)
18351c03a2d0SViresh Kumar 		return 0;
18361c03a2d0SViresh Kumar 
18371c03a2d0SViresh Kumar 	pr_debug("%s: cpu: %d, switching to intermediate freq: oldfreq: %u, intermediate freq: %u\n",
18381c03a2d0SViresh Kumar 		 __func__, policy->cpu, freqs->old, freqs->new);
18391c03a2d0SViresh Kumar 
18401c03a2d0SViresh Kumar 	cpufreq_freq_transition_begin(policy, freqs);
18411c03a2d0SViresh Kumar 	ret = cpufreq_driver->target_intermediate(policy, index);
18421c03a2d0SViresh Kumar 	cpufreq_freq_transition_end(policy, freqs, ret);
18431c03a2d0SViresh Kumar 
18441c03a2d0SViresh Kumar 	if (ret)
18451c03a2d0SViresh Kumar 		pr_err("%s: Failed to change to intermediate frequency: %d\n",
18461c03a2d0SViresh Kumar 		       __func__, ret);
18471c03a2d0SViresh Kumar 
18481c03a2d0SViresh Kumar 	return ret;
18491c03a2d0SViresh Kumar }
18501c03a2d0SViresh Kumar 
18518d65775dSViresh Kumar static int __target_index(struct cpufreq_policy *policy,
18528d65775dSViresh Kumar 			  struct cpufreq_frequency_table *freq_table, int index)
18538d65775dSViresh Kumar {
18541c03a2d0SViresh Kumar 	struct cpufreq_freqs freqs = {.old = policy->cur, .flags = 0};
18551c03a2d0SViresh Kumar 	unsigned int intermediate_freq = 0;
18568d65775dSViresh Kumar 	int retval = -EINVAL;
18578d65775dSViresh Kumar 	bool notify;
18588d65775dSViresh Kumar 
18598d65775dSViresh Kumar 	notify = !(cpufreq_driver->flags & CPUFREQ_ASYNC_NOTIFICATION);
18608d65775dSViresh Kumar 	if (notify) {
18611c03a2d0SViresh Kumar 		/* Handle switching to intermediate frequency */
18621c03a2d0SViresh Kumar 		if (cpufreq_driver->get_intermediate) {
18631c03a2d0SViresh Kumar 			retval = __target_intermediate(policy, &freqs, index);
18641c03a2d0SViresh Kumar 			if (retval)
18651c03a2d0SViresh Kumar 				return retval;
18668d65775dSViresh Kumar 
18671c03a2d0SViresh Kumar 			intermediate_freq = freqs.new;
18681c03a2d0SViresh Kumar 			/* Set old freq to intermediate */
18691c03a2d0SViresh Kumar 			if (intermediate_freq)
18701c03a2d0SViresh Kumar 				freqs.old = freqs.new;
18711c03a2d0SViresh Kumar 		}
18721c03a2d0SViresh Kumar 
18731c03a2d0SViresh Kumar 		freqs.new = freq_table[index].frequency;
18748d65775dSViresh Kumar 		pr_debug("%s: cpu: %d, oldfreq: %u, new freq: %u\n",
18758d65775dSViresh Kumar 			 __func__, policy->cpu, freqs.old, freqs.new);
18768d65775dSViresh Kumar 
18778d65775dSViresh Kumar 		cpufreq_freq_transition_begin(policy, &freqs);
18788d65775dSViresh Kumar 	}
18798d65775dSViresh Kumar 
18808d65775dSViresh Kumar 	retval = cpufreq_driver->target_index(policy, index);
18818d65775dSViresh Kumar 	if (retval)
18828d65775dSViresh Kumar 		pr_err("%s: Failed to change cpu frequency: %d\n", __func__,
18838d65775dSViresh Kumar 		       retval);
18848d65775dSViresh Kumar 
18851c03a2d0SViresh Kumar 	if (notify) {
18868d65775dSViresh Kumar 		cpufreq_freq_transition_end(policy, &freqs, retval);
18878d65775dSViresh Kumar 
18881c03a2d0SViresh Kumar 		/*
18891c03a2d0SViresh Kumar 		 * Failed after setting to intermediate freq? Driver should have
18901c03a2d0SViresh Kumar 		 * reverted back to initial frequency and so should we. Check
18911c03a2d0SViresh Kumar 		 * here for intermediate_freq instead of get_intermediate, in
18921c03a2d0SViresh Kumar 		 * case we have't switched to intermediate freq at all.
18931c03a2d0SViresh Kumar 		 */
18941c03a2d0SViresh Kumar 		if (unlikely(retval && intermediate_freq)) {
18951c03a2d0SViresh Kumar 			freqs.old = intermediate_freq;
18961c03a2d0SViresh Kumar 			freqs.new = policy->restore_freq;
18971c03a2d0SViresh Kumar 			cpufreq_freq_transition_begin(policy, &freqs);
18981c03a2d0SViresh Kumar 			cpufreq_freq_transition_end(policy, &freqs, 0);
18991c03a2d0SViresh Kumar 		}
19001c03a2d0SViresh Kumar 	}
19011c03a2d0SViresh Kumar 
19028d65775dSViresh Kumar 	return retval;
19038d65775dSViresh Kumar }
19048d65775dSViresh Kumar 
19051da177e4SLinus Torvalds int __cpufreq_driver_target(struct cpufreq_policy *policy,
19061da177e4SLinus Torvalds 			    unsigned int target_freq,
19071da177e4SLinus Torvalds 			    unsigned int relation)
19081da177e4SLinus Torvalds {
19097249924eSViresh Kumar 	unsigned int old_target_freq = target_freq;
19108d65775dSViresh Kumar 	int retval = -EINVAL;
1911c32b6b8eSAshok Raj 
1912a7b422cdSKonrad Rzeszutek Wilk 	if (cpufreq_disabled())
1913a7b422cdSKonrad Rzeszutek Wilk 		return -ENODEV;
1914a7b422cdSKonrad Rzeszutek Wilk 
19157249924eSViresh Kumar 	/* Make sure that target_freq is within supported range */
19167249924eSViresh Kumar 	if (target_freq > policy->max)
19177249924eSViresh Kumar 		target_freq = policy->max;
19187249924eSViresh Kumar 	if (target_freq < policy->min)
19197249924eSViresh Kumar 		target_freq = policy->min;
19207249924eSViresh Kumar 
19217249924eSViresh Kumar 	pr_debug("target for CPU %u: %u kHz, relation %u, requested %u kHz\n",
19227249924eSViresh Kumar 		 policy->cpu, target_freq, relation, old_target_freq);
19235a1c0228SViresh Kumar 
19249c0ebcf7SViresh Kumar 	/*
19259c0ebcf7SViresh Kumar 	 * This might look like a redundant call as we are checking it again
19269c0ebcf7SViresh Kumar 	 * after finding index. But it is left intentionally for cases where
19279c0ebcf7SViresh Kumar 	 * exactly same freq is called again and so we can save on few function
19289c0ebcf7SViresh Kumar 	 * calls.
19299c0ebcf7SViresh Kumar 	 */
19305a1c0228SViresh Kumar 	if (target_freq == policy->cur)
19315a1c0228SViresh Kumar 		return 0;
19325a1c0228SViresh Kumar 
19331c03a2d0SViresh Kumar 	/* Save last value to restore later on errors */
19341c03a2d0SViresh Kumar 	policy->restore_freq = policy->cur;
19351c03a2d0SViresh Kumar 
19361c3d85ddSRafael J. Wysocki 	if (cpufreq_driver->target)
19371c3d85ddSRafael J. Wysocki 		retval = cpufreq_driver->target(policy, target_freq, relation);
19389c0ebcf7SViresh Kumar 	else if (cpufreq_driver->target_index) {
19399c0ebcf7SViresh Kumar 		struct cpufreq_frequency_table *freq_table;
19409c0ebcf7SViresh Kumar 		int index;
194190d45d17SAshok Raj 
19429c0ebcf7SViresh Kumar 		freq_table = cpufreq_frequency_get_table(policy->cpu);
19439c0ebcf7SViresh Kumar 		if (unlikely(!freq_table)) {
19449c0ebcf7SViresh Kumar 			pr_err("%s: Unable to find freq_table\n", __func__);
19459c0ebcf7SViresh Kumar 			goto out;
19469c0ebcf7SViresh Kumar 		}
19479c0ebcf7SViresh Kumar 
19489c0ebcf7SViresh Kumar 		retval = cpufreq_frequency_table_target(policy, freq_table,
19499c0ebcf7SViresh Kumar 				target_freq, relation, &index);
19509c0ebcf7SViresh Kumar 		if (unlikely(retval)) {
19519c0ebcf7SViresh Kumar 			pr_err("%s: Unable to find matching freq\n", __func__);
19529c0ebcf7SViresh Kumar 			goto out;
19539c0ebcf7SViresh Kumar 		}
19549c0ebcf7SViresh Kumar 
1955d4019f0aSViresh Kumar 		if (freq_table[index].frequency == policy->cur) {
19569c0ebcf7SViresh Kumar 			retval = 0;
1957d4019f0aSViresh Kumar 			goto out;
1958d4019f0aSViresh Kumar 		}
1959d4019f0aSViresh Kumar 
19608d65775dSViresh Kumar 		retval = __target_index(policy, freq_table, index);
19619c0ebcf7SViresh Kumar 	}
19629c0ebcf7SViresh Kumar 
19639c0ebcf7SViresh Kumar out:
19641da177e4SLinus Torvalds 	return retval;
19651da177e4SLinus Torvalds }
19661da177e4SLinus Torvalds EXPORT_SYMBOL_GPL(__cpufreq_driver_target);
19671da177e4SLinus Torvalds 
19681da177e4SLinus Torvalds int cpufreq_driver_target(struct cpufreq_policy *policy,
19691da177e4SLinus Torvalds 			  unsigned int target_freq,
19701da177e4SLinus Torvalds 			  unsigned int relation)
19711da177e4SLinus Torvalds {
1972f1829e4aSJulia Lawall 	int ret = -EINVAL;
19731da177e4SLinus Torvalds 
1974ad7722daSviresh kumar 	down_write(&policy->rwsem);
19751da177e4SLinus Torvalds 
19761da177e4SLinus Torvalds 	ret = __cpufreq_driver_target(policy, target_freq, relation);
19771da177e4SLinus Torvalds 
1978ad7722daSviresh kumar 	up_write(&policy->rwsem);
19791da177e4SLinus Torvalds 
19801da177e4SLinus Torvalds 	return ret;
19811da177e4SLinus Torvalds }
19821da177e4SLinus Torvalds EXPORT_SYMBOL_GPL(cpufreq_driver_target);
19831da177e4SLinus Torvalds 
1984e08f5f5bSGautham R Shenoy static int __cpufreq_governor(struct cpufreq_policy *policy,
1985e08f5f5bSGautham R Shenoy 					unsigned int event)
19861da177e4SLinus Torvalds {
1987cc993cabSDave Jones 	int ret;
19886afde10cSThomas Renninger 
19896afde10cSThomas Renninger 	/* Only must be defined when default governor is known to have latency
19906afde10cSThomas Renninger 	   restrictions, like e.g. conservative or ondemand.
19916afde10cSThomas Renninger 	   That this is the case is already ensured in Kconfig
19926afde10cSThomas Renninger 	*/
19936afde10cSThomas Renninger #ifdef CONFIG_CPU_FREQ_GOV_PERFORMANCE
19946afde10cSThomas Renninger 	struct cpufreq_governor *gov = &cpufreq_gov_performance;
19956afde10cSThomas Renninger #else
19966afde10cSThomas Renninger 	struct cpufreq_governor *gov = NULL;
19976afde10cSThomas Renninger #endif
19981c256245SThomas Renninger 
19992f0aea93SViresh Kumar 	/* Don't start any governor operations if we are entering suspend */
20002f0aea93SViresh Kumar 	if (cpufreq_suspended)
20012f0aea93SViresh Kumar 		return 0;
2002cb57720bSEthan Zhao 	/*
2003cb57720bSEthan Zhao 	 * Governor might not be initiated here if ACPI _PPC changed
2004cb57720bSEthan Zhao 	 * notification happened, so check it.
2005cb57720bSEthan Zhao 	 */
2006cb57720bSEthan Zhao 	if (!policy->governor)
2007cb57720bSEthan Zhao 		return -EINVAL;
20082f0aea93SViresh Kumar 
20091c256245SThomas Renninger 	if (policy->governor->max_transition_latency &&
20101c256245SThomas Renninger 	    policy->cpuinfo.transition_latency >
20111c256245SThomas Renninger 	    policy->governor->max_transition_latency) {
20126afde10cSThomas Renninger 		if (!gov)
20136afde10cSThomas Renninger 			return -EINVAL;
20146afde10cSThomas Renninger 		else {
2015e837f9b5SJoe Perches 			pr_warn("%s governor failed, too long transition latency of HW, fallback to %s governor\n",
2016e837f9b5SJoe Perches 				policy->governor->name, gov->name);
20171c256245SThomas Renninger 			policy->governor = gov;
20181c256245SThomas Renninger 		}
20196afde10cSThomas Renninger 	}
20201da177e4SLinus Torvalds 
2021fe492f3fSViresh Kumar 	if (event == CPUFREQ_GOV_POLICY_INIT)
20221da177e4SLinus Torvalds 		if (!try_module_get(policy->governor->owner))
20231da177e4SLinus Torvalds 			return -EINVAL;
20241da177e4SLinus Torvalds 
20252d06d8c4SDominik Brodowski 	pr_debug("__cpufreq_governor for CPU %u, event %u\n",
2026e08f5f5bSGautham R Shenoy 		 policy->cpu, event);
202795731ebbSXiaoguang Chen 
202895731ebbSXiaoguang Chen 	mutex_lock(&cpufreq_governor_lock);
202956d07db2SSrivatsa S. Bhat 	if ((policy->governor_enabled && event == CPUFREQ_GOV_START)
2030f73d3933SViresh Kumar 	    || (!policy->governor_enabled
2031f73d3933SViresh Kumar 	    && (event == CPUFREQ_GOV_LIMITS || event == CPUFREQ_GOV_STOP))) {
203295731ebbSXiaoguang Chen 		mutex_unlock(&cpufreq_governor_lock);
203395731ebbSXiaoguang Chen 		return -EBUSY;
203495731ebbSXiaoguang Chen 	}
203595731ebbSXiaoguang Chen 
203695731ebbSXiaoguang Chen 	if (event == CPUFREQ_GOV_STOP)
203795731ebbSXiaoguang Chen 		policy->governor_enabled = false;
203895731ebbSXiaoguang Chen 	else if (event == CPUFREQ_GOV_START)
203995731ebbSXiaoguang Chen 		policy->governor_enabled = true;
204095731ebbSXiaoguang Chen 
204195731ebbSXiaoguang Chen 	mutex_unlock(&cpufreq_governor_lock);
204295731ebbSXiaoguang Chen 
20431da177e4SLinus Torvalds 	ret = policy->governor->governor(policy, event);
20441da177e4SLinus Torvalds 
20454d5dcc42SViresh Kumar 	if (!ret) {
20464d5dcc42SViresh Kumar 		if (event == CPUFREQ_GOV_POLICY_INIT)
20478e53695fSViresh Kumar 			policy->governor->initialized++;
20484d5dcc42SViresh Kumar 		else if (event == CPUFREQ_GOV_POLICY_EXIT)
20498e53695fSViresh Kumar 			policy->governor->initialized--;
205095731ebbSXiaoguang Chen 	} else {
205195731ebbSXiaoguang Chen 		/* Restore original values */
205295731ebbSXiaoguang Chen 		mutex_lock(&cpufreq_governor_lock);
205395731ebbSXiaoguang Chen 		if (event == CPUFREQ_GOV_STOP)
205495731ebbSXiaoguang Chen 			policy->governor_enabled = true;
205595731ebbSXiaoguang Chen 		else if (event == CPUFREQ_GOV_START)
205695731ebbSXiaoguang Chen 			policy->governor_enabled = false;
205795731ebbSXiaoguang Chen 		mutex_unlock(&cpufreq_governor_lock);
20584d5dcc42SViresh Kumar 	}
2059b394058fSViresh Kumar 
2060fe492f3fSViresh Kumar 	if (((event == CPUFREQ_GOV_POLICY_INIT) && ret) ||
2061fe492f3fSViresh Kumar 			((event == CPUFREQ_GOV_POLICY_EXIT) && !ret))
20621da177e4SLinus Torvalds 		module_put(policy->governor->owner);
20631da177e4SLinus Torvalds 
20641da177e4SLinus Torvalds 	return ret;
20651da177e4SLinus Torvalds }
20661da177e4SLinus Torvalds 
20671da177e4SLinus Torvalds int cpufreq_register_governor(struct cpufreq_governor *governor)
20681da177e4SLinus Torvalds {
20693bcb09a3SJeremy Fitzhardinge 	int err;
20701da177e4SLinus Torvalds 
20711da177e4SLinus Torvalds 	if (!governor)
20721da177e4SLinus Torvalds 		return -EINVAL;
20731da177e4SLinus Torvalds 
2074a7b422cdSKonrad Rzeszutek Wilk 	if (cpufreq_disabled())
2075a7b422cdSKonrad Rzeszutek Wilk 		return -ENODEV;
2076a7b422cdSKonrad Rzeszutek Wilk 
20773fc54d37Sakpm@osdl.org 	mutex_lock(&cpufreq_governor_mutex);
20781da177e4SLinus Torvalds 
2079b394058fSViresh Kumar 	governor->initialized = 0;
20803bcb09a3SJeremy Fitzhardinge 	err = -EBUSY;
208142f91fa1SViresh Kumar 	if (!find_governor(governor->name)) {
20823bcb09a3SJeremy Fitzhardinge 		err = 0;
20831da177e4SLinus Torvalds 		list_add(&governor->governor_list, &cpufreq_governor_list);
20843bcb09a3SJeremy Fitzhardinge 	}
20851da177e4SLinus Torvalds 
20863fc54d37Sakpm@osdl.org 	mutex_unlock(&cpufreq_governor_mutex);
20873bcb09a3SJeremy Fitzhardinge 	return err;
20881da177e4SLinus Torvalds }
20891da177e4SLinus Torvalds EXPORT_SYMBOL_GPL(cpufreq_register_governor);
20901da177e4SLinus Torvalds 
20911da177e4SLinus Torvalds void cpufreq_unregister_governor(struct cpufreq_governor *governor)
20921da177e4SLinus Torvalds {
209390e41bacSPrarit Bhargava 	int cpu;
209490e41bacSPrarit Bhargava 
20951da177e4SLinus Torvalds 	if (!governor)
20961da177e4SLinus Torvalds 		return;
20971da177e4SLinus Torvalds 
2098a7b422cdSKonrad Rzeszutek Wilk 	if (cpufreq_disabled())
2099a7b422cdSKonrad Rzeszutek Wilk 		return;
2100a7b422cdSKonrad Rzeszutek Wilk 
210190e41bacSPrarit Bhargava 	for_each_present_cpu(cpu) {
210290e41bacSPrarit Bhargava 		if (cpu_online(cpu))
210390e41bacSPrarit Bhargava 			continue;
210490e41bacSPrarit Bhargava 		if (!strcmp(per_cpu(cpufreq_cpu_governor, cpu), governor->name))
210590e41bacSPrarit Bhargava 			strcpy(per_cpu(cpufreq_cpu_governor, cpu), "\0");
210690e41bacSPrarit Bhargava 	}
210790e41bacSPrarit Bhargava 
21083fc54d37Sakpm@osdl.org 	mutex_lock(&cpufreq_governor_mutex);
21091da177e4SLinus Torvalds 	list_del(&governor->governor_list);
21103fc54d37Sakpm@osdl.org 	mutex_unlock(&cpufreq_governor_mutex);
21111da177e4SLinus Torvalds 	return;
21121da177e4SLinus Torvalds }
21131da177e4SLinus Torvalds EXPORT_SYMBOL_GPL(cpufreq_unregister_governor);
21141da177e4SLinus Torvalds 
21151da177e4SLinus Torvalds 
21161da177e4SLinus Torvalds /*********************************************************************
21171da177e4SLinus Torvalds  *                          POLICY INTERFACE                         *
21181da177e4SLinus Torvalds  *********************************************************************/
21191da177e4SLinus Torvalds 
21201da177e4SLinus Torvalds /**
21211da177e4SLinus Torvalds  * cpufreq_get_policy - get the current cpufreq_policy
212229464f28SDave Jones  * @policy: struct cpufreq_policy into which the current cpufreq_policy
212329464f28SDave Jones  *	is written
21241da177e4SLinus Torvalds  *
21251da177e4SLinus Torvalds  * Reads the current cpufreq policy.
21261da177e4SLinus Torvalds  */
21271da177e4SLinus Torvalds int cpufreq_get_policy(struct cpufreq_policy *policy, unsigned int cpu)
21281da177e4SLinus Torvalds {
21291da177e4SLinus Torvalds 	struct cpufreq_policy *cpu_policy;
21301da177e4SLinus Torvalds 	if (!policy)
21311da177e4SLinus Torvalds 		return -EINVAL;
21321da177e4SLinus Torvalds 
21331da177e4SLinus Torvalds 	cpu_policy = cpufreq_cpu_get(cpu);
21341da177e4SLinus Torvalds 	if (!cpu_policy)
21351da177e4SLinus Torvalds 		return -EINVAL;
21361da177e4SLinus Torvalds 
2137d5b73cd8SViresh Kumar 	memcpy(policy, cpu_policy, sizeof(*policy));
21381da177e4SLinus Torvalds 
21391da177e4SLinus Torvalds 	cpufreq_cpu_put(cpu_policy);
21401da177e4SLinus Torvalds 	return 0;
21411da177e4SLinus Torvalds }
21421da177e4SLinus Torvalds EXPORT_SYMBOL(cpufreq_get_policy);
21431da177e4SLinus Torvalds 
2144153d7f3fSArjan van de Ven /*
2145037ce839SViresh Kumar  * policy : current policy.
2146037ce839SViresh Kumar  * new_policy: policy to be set.
2147153d7f3fSArjan van de Ven  */
2148037ce839SViresh Kumar static int cpufreq_set_policy(struct cpufreq_policy *policy,
21493a3e9e06SViresh Kumar 				struct cpufreq_policy *new_policy)
21501da177e4SLinus Torvalds {
2151d9a789c7SRafael J. Wysocki 	struct cpufreq_governor *old_gov;
2152d9a789c7SRafael J. Wysocki 	int ret;
21531da177e4SLinus Torvalds 
2154e837f9b5SJoe Perches 	pr_debug("setting new policy for CPU %u: %u - %u kHz\n",
2155e837f9b5SJoe Perches 		 new_policy->cpu, new_policy->min, new_policy->max);
21561da177e4SLinus Torvalds 
2157d5b73cd8SViresh Kumar 	memcpy(&new_policy->cpuinfo, &policy->cpuinfo, sizeof(policy->cpuinfo));
21581da177e4SLinus Torvalds 
2159d9a789c7SRafael J. Wysocki 	if (new_policy->min > policy->max || new_policy->max < policy->min)
2160d9a789c7SRafael J. Wysocki 		return -EINVAL;
21619c9a43edSMattia Dongili 
21621da177e4SLinus Torvalds 	/* verify the cpu speed can be set within this limit */
21633a3e9e06SViresh Kumar 	ret = cpufreq_driver->verify(new_policy);
21641da177e4SLinus Torvalds 	if (ret)
2165d9a789c7SRafael J. Wysocki 		return ret;
21661da177e4SLinus Torvalds 
21671da177e4SLinus Torvalds 	/* adjust if necessary - all reasons */
2168e041c683SAlan Stern 	blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
21693a3e9e06SViresh Kumar 			CPUFREQ_ADJUST, new_policy);
21701da177e4SLinus Torvalds 
21711da177e4SLinus Torvalds 	/* adjust if necessary - hardware incompatibility*/
2172e041c683SAlan Stern 	blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
21733a3e9e06SViresh Kumar 			CPUFREQ_INCOMPATIBLE, new_policy);
21741da177e4SLinus Torvalds 
2175bb176f7dSViresh Kumar 	/*
2176bb176f7dSViresh Kumar 	 * verify the cpu speed can be set within this limit, which might be
2177bb176f7dSViresh Kumar 	 * different to the first one
2178bb176f7dSViresh Kumar 	 */
21793a3e9e06SViresh Kumar 	ret = cpufreq_driver->verify(new_policy);
2180e041c683SAlan Stern 	if (ret)
2181d9a789c7SRafael J. Wysocki 		return ret;
21821da177e4SLinus Torvalds 
21831da177e4SLinus Torvalds 	/* notification of the new policy */
2184e041c683SAlan Stern 	blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
21853a3e9e06SViresh Kumar 			CPUFREQ_NOTIFY, new_policy);
21861da177e4SLinus Torvalds 
21873a3e9e06SViresh Kumar 	policy->min = new_policy->min;
21883a3e9e06SViresh Kumar 	policy->max = new_policy->max;
21891da177e4SLinus Torvalds 
21902d06d8c4SDominik Brodowski 	pr_debug("new min and max freqs are %u - %u kHz\n",
21913a3e9e06SViresh Kumar 		 policy->min, policy->max);
21921da177e4SLinus Torvalds 
21931c3d85ddSRafael J. Wysocki 	if (cpufreq_driver->setpolicy) {
21943a3e9e06SViresh Kumar 		policy->policy = new_policy->policy;
21952d06d8c4SDominik Brodowski 		pr_debug("setting range\n");
2196d9a789c7SRafael J. Wysocki 		return cpufreq_driver->setpolicy(new_policy);
2197d9a789c7SRafael J. Wysocki 	}
2198d9a789c7SRafael J. Wysocki 
2199d9a789c7SRafael J. Wysocki 	if (new_policy->governor == policy->governor)
2200d9a789c7SRafael J. Wysocki 		goto out;
22011da177e4SLinus Torvalds 
22022d06d8c4SDominik Brodowski 	pr_debug("governor switch\n");
22031da177e4SLinus Torvalds 
2204d9a789c7SRafael J. Wysocki 	/* save old, working values */
2205d9a789c7SRafael J. Wysocki 	old_gov = policy->governor;
22061da177e4SLinus Torvalds 	/* end old governor */
2207d9a789c7SRafael J. Wysocki 	if (old_gov) {
22083a3e9e06SViresh Kumar 		__cpufreq_governor(policy, CPUFREQ_GOV_STOP);
2209ad7722daSviresh kumar 		up_write(&policy->rwsem);
2210d9a789c7SRafael J. Wysocki 		__cpufreq_governor(policy, CPUFREQ_GOV_POLICY_EXIT);
2211ad7722daSviresh kumar 		down_write(&policy->rwsem);
22127bd353a9SViresh Kumar 	}
22131da177e4SLinus Torvalds 
22141da177e4SLinus Torvalds 	/* start new governor */
22153a3e9e06SViresh Kumar 	policy->governor = new_policy->governor;
22163a3e9e06SViresh Kumar 	if (!__cpufreq_governor(policy, CPUFREQ_GOV_POLICY_INIT)) {
2217d9a789c7SRafael J. Wysocki 		if (!__cpufreq_governor(policy, CPUFREQ_GOV_START))
2218d9a789c7SRafael J. Wysocki 			goto out;
2219d9a789c7SRafael J. Wysocki 
2220ad7722daSviresh kumar 		up_write(&policy->rwsem);
2221d9a789c7SRafael J. Wysocki 		__cpufreq_governor(policy, CPUFREQ_GOV_POLICY_EXIT);
2222ad7722daSviresh kumar 		down_write(&policy->rwsem);
2223955ef483SViresh Kumar 	}
22247bd353a9SViresh Kumar 
22251da177e4SLinus Torvalds 	/* new governor failed, so re-start old one */
2226d9a789c7SRafael J. Wysocki 	pr_debug("starting governor %s failed\n", policy->governor->name);
22271da177e4SLinus Torvalds 	if (old_gov) {
22283a3e9e06SViresh Kumar 		policy->governor = old_gov;
2229d9a789c7SRafael J. Wysocki 		__cpufreq_governor(policy, CPUFREQ_GOV_POLICY_INIT);
2230d9a789c7SRafael J. Wysocki 		__cpufreq_governor(policy, CPUFREQ_GOV_START);
22311da177e4SLinus Torvalds 	}
22321da177e4SLinus Torvalds 
2233d9a789c7SRafael J. Wysocki 	return -EINVAL;
2234d9a789c7SRafael J. Wysocki 
2235d9a789c7SRafael J. Wysocki  out:
2236d9a789c7SRafael J. Wysocki 	pr_debug("governor: change or update limits\n");
2237d9a789c7SRafael J. Wysocki 	return __cpufreq_governor(policy, CPUFREQ_GOV_LIMITS);
22381da177e4SLinus Torvalds }
22391da177e4SLinus Torvalds 
22401da177e4SLinus Torvalds /**
22411da177e4SLinus Torvalds  *	cpufreq_update_policy - re-evaluate an existing cpufreq policy
22421da177e4SLinus Torvalds  *	@cpu: CPU which shall be re-evaluated
22431da177e4SLinus Torvalds  *
224425985edcSLucas De Marchi  *	Useful for policy notifiers which have different necessities
22451da177e4SLinus Torvalds  *	at different times.
22461da177e4SLinus Torvalds  */
22471da177e4SLinus Torvalds int cpufreq_update_policy(unsigned int cpu)
22481da177e4SLinus Torvalds {
22493a3e9e06SViresh Kumar 	struct cpufreq_policy *policy = cpufreq_cpu_get(cpu);
22503a3e9e06SViresh Kumar 	struct cpufreq_policy new_policy;
2251f1829e4aSJulia Lawall 	int ret;
22521da177e4SLinus Torvalds 
2253fefa8ff8SAaron Plattner 	if (!policy)
2254fefa8ff8SAaron Plattner 		return -ENODEV;
22551da177e4SLinus Torvalds 
2256ad7722daSviresh kumar 	down_write(&policy->rwsem);
22571da177e4SLinus Torvalds 
22582d06d8c4SDominik Brodowski 	pr_debug("updating policy for CPU %u\n", cpu);
2259d5b73cd8SViresh Kumar 	memcpy(&new_policy, policy, sizeof(*policy));
22603a3e9e06SViresh Kumar 	new_policy.min = policy->user_policy.min;
22613a3e9e06SViresh Kumar 	new_policy.max = policy->user_policy.max;
22623a3e9e06SViresh Kumar 	new_policy.policy = policy->user_policy.policy;
22633a3e9e06SViresh Kumar 	new_policy.governor = policy->user_policy.governor;
22641da177e4SLinus Torvalds 
2265bb176f7dSViresh Kumar 	/*
2266bb176f7dSViresh Kumar 	 * BIOS might change freq behind our back
2267bb176f7dSViresh Kumar 	 * -> ask driver for current freq and notify governors about a change
2268bb176f7dSViresh Kumar 	 */
22692ed99e39SRafael J. Wysocki 	if (cpufreq_driver->get && !cpufreq_driver->setpolicy) {
22703a3e9e06SViresh Kumar 		new_policy.cur = cpufreq_driver->get(cpu);
2271bd0fa9bbSViresh Kumar 		if (WARN_ON(!new_policy.cur)) {
2272bd0fa9bbSViresh Kumar 			ret = -EIO;
2273fefa8ff8SAaron Plattner 			goto unlock;
2274bd0fa9bbSViresh Kumar 		}
2275bd0fa9bbSViresh Kumar 
22763a3e9e06SViresh Kumar 		if (!policy->cur) {
2277e837f9b5SJoe Perches 			pr_debug("Driver did not initialize current freq\n");
22783a3e9e06SViresh Kumar 			policy->cur = new_policy.cur;
2279a85f7bd3SThomas Renninger 		} else {
22809c0ebcf7SViresh Kumar 			if (policy->cur != new_policy.cur && has_target())
2281a1e1dc41SViresh Kumar 				cpufreq_out_of_sync(policy, new_policy.cur);
22820961dd0dSThomas Renninger 		}
2283a85f7bd3SThomas Renninger 	}
22840961dd0dSThomas Renninger 
2285037ce839SViresh Kumar 	ret = cpufreq_set_policy(policy, &new_policy);
22861da177e4SLinus Torvalds 
2287fefa8ff8SAaron Plattner unlock:
2288ad7722daSviresh kumar 	up_write(&policy->rwsem);
22895a01f2e8SVenkatesh Pallipadi 
22903a3e9e06SViresh Kumar 	cpufreq_cpu_put(policy);
22911da177e4SLinus Torvalds 	return ret;
22921da177e4SLinus Torvalds }
22931da177e4SLinus Torvalds EXPORT_SYMBOL(cpufreq_update_policy);
22941da177e4SLinus Torvalds 
22952760984fSPaul Gortmaker static int cpufreq_cpu_callback(struct notifier_block *nfb,
2296c32b6b8eSAshok Raj 					unsigned long action, void *hcpu)
2297c32b6b8eSAshok Raj {
2298c32b6b8eSAshok Raj 	unsigned int cpu = (unsigned long)hcpu;
22998a25a2fdSKay Sievers 	struct device *dev;
2300c32b6b8eSAshok Raj 
23018a25a2fdSKay Sievers 	dev = get_cpu_device(cpu);
23028a25a2fdSKay Sievers 	if (dev) {
23035302c3fbSSrivatsa S. Bhat 		switch (action & ~CPU_TASKS_FROZEN) {
2304c32b6b8eSAshok Raj 		case CPU_ONLINE:
230596bbbe4aSViresh Kumar 			__cpufreq_add_dev(dev, NULL);
2306c32b6b8eSAshok Raj 			break;
23075302c3fbSSrivatsa S. Bhat 
2308c32b6b8eSAshok Raj 		case CPU_DOWN_PREPARE:
230996bbbe4aSViresh Kumar 			__cpufreq_remove_dev_prepare(dev, NULL);
23101aee40acSSrivatsa S. Bhat 			break;
23111aee40acSSrivatsa S. Bhat 
23121aee40acSSrivatsa S. Bhat 		case CPU_POST_DEAD:
231396bbbe4aSViresh Kumar 			__cpufreq_remove_dev_finish(dev, NULL);
2314c32b6b8eSAshok Raj 			break;
23155302c3fbSSrivatsa S. Bhat 
23165a01f2e8SVenkatesh Pallipadi 		case CPU_DOWN_FAILED:
231796bbbe4aSViresh Kumar 			__cpufreq_add_dev(dev, NULL);
2318c32b6b8eSAshok Raj 			break;
2319c32b6b8eSAshok Raj 		}
2320c32b6b8eSAshok Raj 	}
2321c32b6b8eSAshok Raj 	return NOTIFY_OK;
2322c32b6b8eSAshok Raj }
2323c32b6b8eSAshok Raj 
23249c36f746SNeal Buckendahl static struct notifier_block __refdata cpufreq_cpu_notifier = {
2325c32b6b8eSAshok Raj 	.notifier_call = cpufreq_cpu_callback,
2326c32b6b8eSAshok Raj };
23271da177e4SLinus Torvalds 
23281da177e4SLinus Torvalds /*********************************************************************
23296f19efc0SLukasz Majewski  *               BOOST						     *
23306f19efc0SLukasz Majewski  *********************************************************************/
23316f19efc0SLukasz Majewski static int cpufreq_boost_set_sw(int state)
23326f19efc0SLukasz Majewski {
23336f19efc0SLukasz Majewski 	struct cpufreq_frequency_table *freq_table;
23346f19efc0SLukasz Majewski 	struct cpufreq_policy *policy;
23356f19efc0SLukasz Majewski 	int ret = -EINVAL;
23366f19efc0SLukasz Majewski 
23376f19efc0SLukasz Majewski 	list_for_each_entry(policy, &cpufreq_policy_list, policy_list) {
23386f19efc0SLukasz Majewski 		freq_table = cpufreq_frequency_get_table(policy->cpu);
23396f19efc0SLukasz Majewski 		if (freq_table) {
23406f19efc0SLukasz Majewski 			ret = cpufreq_frequency_table_cpuinfo(policy,
23416f19efc0SLukasz Majewski 							freq_table);
23426f19efc0SLukasz Majewski 			if (ret) {
23436f19efc0SLukasz Majewski 				pr_err("%s: Policy frequency update failed\n",
23446f19efc0SLukasz Majewski 				       __func__);
23456f19efc0SLukasz Majewski 				break;
23466f19efc0SLukasz Majewski 			}
23476f19efc0SLukasz Majewski 			policy->user_policy.max = policy->max;
23486f19efc0SLukasz Majewski 			__cpufreq_governor(policy, CPUFREQ_GOV_LIMITS);
23496f19efc0SLukasz Majewski 		}
23506f19efc0SLukasz Majewski 	}
23516f19efc0SLukasz Majewski 
23526f19efc0SLukasz Majewski 	return ret;
23536f19efc0SLukasz Majewski }
23546f19efc0SLukasz Majewski 
23556f19efc0SLukasz Majewski int cpufreq_boost_trigger_state(int state)
23566f19efc0SLukasz Majewski {
23576f19efc0SLukasz Majewski 	unsigned long flags;
23586f19efc0SLukasz Majewski 	int ret = 0;
23596f19efc0SLukasz Majewski 
23606f19efc0SLukasz Majewski 	if (cpufreq_driver->boost_enabled == state)
23616f19efc0SLukasz Majewski 		return 0;
23626f19efc0SLukasz Majewski 
23636f19efc0SLukasz Majewski 	write_lock_irqsave(&cpufreq_driver_lock, flags);
23646f19efc0SLukasz Majewski 	cpufreq_driver->boost_enabled = state;
23656f19efc0SLukasz Majewski 	write_unlock_irqrestore(&cpufreq_driver_lock, flags);
23666f19efc0SLukasz Majewski 
23676f19efc0SLukasz Majewski 	ret = cpufreq_driver->set_boost(state);
23686f19efc0SLukasz Majewski 	if (ret) {
23696f19efc0SLukasz Majewski 		write_lock_irqsave(&cpufreq_driver_lock, flags);
23706f19efc0SLukasz Majewski 		cpufreq_driver->boost_enabled = !state;
23716f19efc0SLukasz Majewski 		write_unlock_irqrestore(&cpufreq_driver_lock, flags);
23726f19efc0SLukasz Majewski 
2373e837f9b5SJoe Perches 		pr_err("%s: Cannot %s BOOST\n",
2374e837f9b5SJoe Perches 		       __func__, state ? "enable" : "disable");
23756f19efc0SLukasz Majewski 	}
23766f19efc0SLukasz Majewski 
23776f19efc0SLukasz Majewski 	return ret;
23786f19efc0SLukasz Majewski }
23796f19efc0SLukasz Majewski 
23806f19efc0SLukasz Majewski int cpufreq_boost_supported(void)
23816f19efc0SLukasz Majewski {
23826f19efc0SLukasz Majewski 	if (likely(cpufreq_driver))
23836f19efc0SLukasz Majewski 		return cpufreq_driver->boost_supported;
23846f19efc0SLukasz Majewski 
23856f19efc0SLukasz Majewski 	return 0;
23866f19efc0SLukasz Majewski }
23876f19efc0SLukasz Majewski EXPORT_SYMBOL_GPL(cpufreq_boost_supported);
23886f19efc0SLukasz Majewski 
23896f19efc0SLukasz Majewski int cpufreq_boost_enabled(void)
23906f19efc0SLukasz Majewski {
23916f19efc0SLukasz Majewski 	return cpufreq_driver->boost_enabled;
23926f19efc0SLukasz Majewski }
23936f19efc0SLukasz Majewski EXPORT_SYMBOL_GPL(cpufreq_boost_enabled);
23946f19efc0SLukasz Majewski 
23956f19efc0SLukasz Majewski /*********************************************************************
23961da177e4SLinus Torvalds  *               REGISTER / UNREGISTER CPUFREQ DRIVER                *
23971da177e4SLinus Torvalds  *********************************************************************/
23981da177e4SLinus Torvalds 
23991da177e4SLinus Torvalds /**
24001da177e4SLinus Torvalds  * cpufreq_register_driver - register a CPU Frequency driver
24011da177e4SLinus Torvalds  * @driver_data: A struct cpufreq_driver containing the values#
24021da177e4SLinus Torvalds  * submitted by the CPU Frequency driver.
24031da177e4SLinus Torvalds  *
24041da177e4SLinus Torvalds  * Registers a CPU Frequency driver to this core code. This code
24051da177e4SLinus Torvalds  * returns zero on success, -EBUSY when another driver got here first
24061da177e4SLinus Torvalds  * (and isn't unregistered in the meantime).
24071da177e4SLinus Torvalds  *
24081da177e4SLinus Torvalds  */
2409221dee28SLinus Torvalds int cpufreq_register_driver(struct cpufreq_driver *driver_data)
24101da177e4SLinus Torvalds {
24111da177e4SLinus Torvalds 	unsigned long flags;
24121da177e4SLinus Torvalds 	int ret;
24131da177e4SLinus Torvalds 
2414a7b422cdSKonrad Rzeszutek Wilk 	if (cpufreq_disabled())
2415a7b422cdSKonrad Rzeszutek Wilk 		return -ENODEV;
2416a7b422cdSKonrad Rzeszutek Wilk 
24171da177e4SLinus Torvalds 	if (!driver_data || !driver_data->verify || !driver_data->init ||
24189c0ebcf7SViresh Kumar 	    !(driver_data->setpolicy || driver_data->target_index ||
24199832235fSRafael J. Wysocki 		    driver_data->target) ||
24209832235fSRafael J. Wysocki 	     (driver_data->setpolicy && (driver_data->target_index ||
24211c03a2d0SViresh Kumar 		    driver_data->target)) ||
24221c03a2d0SViresh Kumar 	     (!!driver_data->get_intermediate != !!driver_data->target_intermediate))
24231da177e4SLinus Torvalds 		return -EINVAL;
24241da177e4SLinus Torvalds 
24252d06d8c4SDominik Brodowski 	pr_debug("trying to register driver %s\n", driver_data->name);
24261da177e4SLinus Torvalds 
24270d1857a1SNathan Zimmer 	write_lock_irqsave(&cpufreq_driver_lock, flags);
24281c3d85ddSRafael J. Wysocki 	if (cpufreq_driver) {
24290d1857a1SNathan Zimmer 		write_unlock_irqrestore(&cpufreq_driver_lock, flags);
24304dea5806SYinghai Lu 		return -EEXIST;
24311da177e4SLinus Torvalds 	}
24321c3d85ddSRafael J. Wysocki 	cpufreq_driver = driver_data;
24330d1857a1SNathan Zimmer 	write_unlock_irqrestore(&cpufreq_driver_lock, flags);
24341da177e4SLinus Torvalds 
2435bc68b7dfSViresh Kumar 	if (driver_data->setpolicy)
2436bc68b7dfSViresh Kumar 		driver_data->flags |= CPUFREQ_CONST_LOOPS;
2437bc68b7dfSViresh Kumar 
24386f19efc0SLukasz Majewski 	if (cpufreq_boost_supported()) {
24396f19efc0SLukasz Majewski 		/*
24406f19efc0SLukasz Majewski 		 * Check if driver provides function to enable boost -
24416f19efc0SLukasz Majewski 		 * if not, use cpufreq_boost_set_sw as default
24426f19efc0SLukasz Majewski 		 */
24436f19efc0SLukasz Majewski 		if (!cpufreq_driver->set_boost)
24446f19efc0SLukasz Majewski 			cpufreq_driver->set_boost = cpufreq_boost_set_sw;
24456f19efc0SLukasz Majewski 
24466f19efc0SLukasz Majewski 		ret = cpufreq_sysfs_create_file(&boost.attr);
24476f19efc0SLukasz Majewski 		if (ret) {
24486f19efc0SLukasz Majewski 			pr_err("%s: cannot register global BOOST sysfs file\n",
24496f19efc0SLukasz Majewski 			       __func__);
24506f19efc0SLukasz Majewski 			goto err_null_driver;
24516f19efc0SLukasz Majewski 		}
24526f19efc0SLukasz Majewski 	}
24536f19efc0SLukasz Majewski 
24548a25a2fdSKay Sievers 	ret = subsys_interface_register(&cpufreq_interface);
24558f5bc2abSJiri Slaby 	if (ret)
24566f19efc0SLukasz Majewski 		goto err_boost_unreg;
24571da177e4SLinus Torvalds 
2458*ce1bcfe9SViresh Kumar 	if (!(cpufreq_driver->flags & CPUFREQ_STICKY) &&
2459*ce1bcfe9SViresh Kumar 	    list_empty(&cpufreq_policy_list)) {
24601da177e4SLinus Torvalds 		/* if all ->init() calls failed, unregister */
2461*ce1bcfe9SViresh Kumar 		pr_debug("%s: No CPU initialized for driver %s\n", __func__,
2462e08f5f5bSGautham R Shenoy 			 driver_data->name);
24638a25a2fdSKay Sievers 		goto err_if_unreg;
24641da177e4SLinus Torvalds 	}
24651da177e4SLinus Torvalds 
246665edc68cSChandra Seetharaman 	register_hotcpu_notifier(&cpufreq_cpu_notifier);
24672d06d8c4SDominik Brodowski 	pr_debug("driver %s up and running\n", driver_data->name);
24681da177e4SLinus Torvalds 
24698f5bc2abSJiri Slaby 	return 0;
24708a25a2fdSKay Sievers err_if_unreg:
24718a25a2fdSKay Sievers 	subsys_interface_unregister(&cpufreq_interface);
24726f19efc0SLukasz Majewski err_boost_unreg:
24736f19efc0SLukasz Majewski 	if (cpufreq_boost_supported())
24746f19efc0SLukasz Majewski 		cpufreq_sysfs_remove_file(&boost.attr);
24758f5bc2abSJiri Slaby err_null_driver:
24760d1857a1SNathan Zimmer 	write_lock_irqsave(&cpufreq_driver_lock, flags);
24771c3d85ddSRafael J. Wysocki 	cpufreq_driver = NULL;
24780d1857a1SNathan Zimmer 	write_unlock_irqrestore(&cpufreq_driver_lock, flags);
24794d34a67dSDave Jones 	return ret;
24801da177e4SLinus Torvalds }
24811da177e4SLinus Torvalds EXPORT_SYMBOL_GPL(cpufreq_register_driver);
24821da177e4SLinus Torvalds 
24831da177e4SLinus Torvalds /**
24841da177e4SLinus Torvalds  * cpufreq_unregister_driver - unregister the current CPUFreq driver
24851da177e4SLinus Torvalds  *
24861da177e4SLinus Torvalds  * Unregister the current CPUFreq driver. Only call this if you have
24871da177e4SLinus Torvalds  * the right to do so, i.e. if you have succeeded in initialising before!
24881da177e4SLinus Torvalds  * Returns zero if successful, and -EINVAL if the cpufreq_driver is
24891da177e4SLinus Torvalds  * currently not initialised.
24901da177e4SLinus Torvalds  */
2491221dee28SLinus Torvalds int cpufreq_unregister_driver(struct cpufreq_driver *driver)
24921da177e4SLinus Torvalds {
24931da177e4SLinus Torvalds 	unsigned long flags;
24941da177e4SLinus Torvalds 
24951c3d85ddSRafael J. Wysocki 	if (!cpufreq_driver || (driver != cpufreq_driver))
24961da177e4SLinus Torvalds 		return -EINVAL;
24971da177e4SLinus Torvalds 
24982d06d8c4SDominik Brodowski 	pr_debug("unregistering driver %s\n", driver->name);
24991da177e4SLinus Torvalds 
25008a25a2fdSKay Sievers 	subsys_interface_unregister(&cpufreq_interface);
25016f19efc0SLukasz Majewski 	if (cpufreq_boost_supported())
25026f19efc0SLukasz Majewski 		cpufreq_sysfs_remove_file(&boost.attr);
25036f19efc0SLukasz Majewski 
250465edc68cSChandra Seetharaman 	unregister_hotcpu_notifier(&cpufreq_cpu_notifier);
25051da177e4SLinus Torvalds 
25066eed9404SViresh Kumar 	down_write(&cpufreq_rwsem);
25070d1857a1SNathan Zimmer 	write_lock_irqsave(&cpufreq_driver_lock, flags);
25086eed9404SViresh Kumar 
25091c3d85ddSRafael J. Wysocki 	cpufreq_driver = NULL;
25106eed9404SViresh Kumar 
25110d1857a1SNathan Zimmer 	write_unlock_irqrestore(&cpufreq_driver_lock, flags);
25126eed9404SViresh Kumar 	up_write(&cpufreq_rwsem);
25131da177e4SLinus Torvalds 
25141da177e4SLinus Torvalds 	return 0;
25151da177e4SLinus Torvalds }
25161da177e4SLinus Torvalds EXPORT_SYMBOL_GPL(cpufreq_unregister_driver);
25175a01f2e8SVenkatesh Pallipadi 
251890de2a4aSDoug Anderson /*
251990de2a4aSDoug Anderson  * Stop cpufreq at shutdown to make sure it isn't holding any locks
252090de2a4aSDoug Anderson  * or mutexes when secondary CPUs are halted.
252190de2a4aSDoug Anderson  */
252290de2a4aSDoug Anderson static struct syscore_ops cpufreq_syscore_ops = {
252390de2a4aSDoug Anderson 	.shutdown = cpufreq_suspend,
252490de2a4aSDoug Anderson };
252590de2a4aSDoug Anderson 
25265a01f2e8SVenkatesh Pallipadi static int __init cpufreq_core_init(void)
25275a01f2e8SVenkatesh Pallipadi {
2528a7b422cdSKonrad Rzeszutek Wilk 	if (cpufreq_disabled())
2529a7b422cdSKonrad Rzeszutek Wilk 		return -ENODEV;
2530a7b422cdSKonrad Rzeszutek Wilk 
25312361be23SViresh Kumar 	cpufreq_global_kobject = kobject_create();
25328aa84ad8SThomas Renninger 	BUG_ON(!cpufreq_global_kobject);
25338aa84ad8SThomas Renninger 
253490de2a4aSDoug Anderson 	register_syscore_ops(&cpufreq_syscore_ops);
253590de2a4aSDoug Anderson 
25365a01f2e8SVenkatesh Pallipadi 	return 0;
25375a01f2e8SVenkatesh Pallipadi }
25385a01f2e8SVenkatesh Pallipadi core_initcall(cpufreq_core_init);
2539