xref: /openbmc/linux/drivers/cpufreq/cpufreq.c (revision 2f0aea9363609433b38ab13f0f86f38372668c68)
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>
29*2f0aea93SViresh Kumar #include <linux/suspend.h>
305ff0a268SViresh Kumar #include <linux/tick.h>
316f4f2723SThomas Renninger #include <trace/events/power.h>
326f4f2723SThomas Renninger 
331da177e4SLinus Torvalds /**
34cd878479SDave Jones  * The "cpufreq driver" - the arch- or hardware-dependent low
351da177e4SLinus Torvalds  * level driver of CPUFreq support, and its spinlock. This lock
361da177e4SLinus Torvalds  * also protects the cpufreq_cpu_data array.
371da177e4SLinus Torvalds  */
381c3d85ddSRafael J. Wysocki static struct cpufreq_driver *cpufreq_driver;
397a6aedfaSMike Travis static DEFINE_PER_CPU(struct cpufreq_policy *, cpufreq_cpu_data);
408414809cSSrivatsa S. Bhat static DEFINE_PER_CPU(struct cpufreq_policy *, cpufreq_cpu_data_fallback);
41bb176f7dSViresh Kumar static DEFINE_RWLOCK(cpufreq_driver_lock);
426f1e4efdSJane Li DEFINE_MUTEX(cpufreq_governor_lock);
43c88a1f8bSLukasz Majewski static LIST_HEAD(cpufreq_policy_list);
44bb176f7dSViresh Kumar 
45084f3493SThomas Renninger /* This one keeps track of the previously set governor of a removed CPU */
46e77b89f1SDmitry Monakhov static DEFINE_PER_CPU(char[CPUFREQ_NAME_LEN], cpufreq_cpu_governor);
471da177e4SLinus Torvalds 
48*2f0aea93SViresh Kumar /* Flag to suspend/resume CPUFreq governors */
49*2f0aea93SViresh Kumar static bool cpufreq_suspended;
50*2f0aea93SViresh Kumar 
519c0ebcf7SViresh Kumar static inline bool has_target(void)
529c0ebcf7SViresh Kumar {
539c0ebcf7SViresh Kumar 	return cpufreq_driver->target_index || cpufreq_driver->target;
549c0ebcf7SViresh Kumar }
559c0ebcf7SViresh Kumar 
565a01f2e8SVenkatesh Pallipadi /*
576eed9404SViresh Kumar  * rwsem to guarantee that cpufreq driver module doesn't unload during critical
586eed9404SViresh Kumar  * sections
596eed9404SViresh Kumar  */
606eed9404SViresh Kumar static DECLARE_RWSEM(cpufreq_rwsem);
616eed9404SViresh Kumar 
621da177e4SLinus Torvalds /* internal prototypes */
6329464f28SDave Jones static int __cpufreq_governor(struct cpufreq_policy *policy,
6429464f28SDave Jones 		unsigned int event);
655a01f2e8SVenkatesh Pallipadi static unsigned int __cpufreq_get(unsigned int cpu);
6665f27f38SDavid Howells static void handle_update(struct work_struct *work);
671da177e4SLinus Torvalds 
681da177e4SLinus Torvalds /**
691da177e4SLinus Torvalds  * Two notifier lists: the "policy" list is involved in the
701da177e4SLinus Torvalds  * validation process for a new CPU frequency policy; the
711da177e4SLinus Torvalds  * "transition" list for kernel code that needs to handle
721da177e4SLinus Torvalds  * changes to devices when the CPU clock speed changes.
731da177e4SLinus Torvalds  * The mutex locks both lists.
741da177e4SLinus Torvalds  */
75e041c683SAlan Stern static BLOCKING_NOTIFIER_HEAD(cpufreq_policy_notifier_list);
76b4dfdbb3SAlan Stern static struct srcu_notifier_head cpufreq_transition_notifier_list;
771da177e4SLinus Torvalds 
7874212ca4SCesar Eduardo Barros static bool init_cpufreq_transition_notifier_list_called;
79b4dfdbb3SAlan Stern static int __init init_cpufreq_transition_notifier_list(void)
80b4dfdbb3SAlan Stern {
81b4dfdbb3SAlan Stern 	srcu_init_notifier_head(&cpufreq_transition_notifier_list);
8274212ca4SCesar Eduardo Barros 	init_cpufreq_transition_notifier_list_called = true;
83b4dfdbb3SAlan Stern 	return 0;
84b4dfdbb3SAlan Stern }
85b3438f82SLinus Torvalds pure_initcall(init_cpufreq_transition_notifier_list);
861da177e4SLinus Torvalds 
87a7b422cdSKonrad Rzeszutek Wilk static int off __read_mostly;
88da584455SViresh Kumar static int cpufreq_disabled(void)
89a7b422cdSKonrad Rzeszutek Wilk {
90a7b422cdSKonrad Rzeszutek Wilk 	return off;
91a7b422cdSKonrad Rzeszutek Wilk }
92a7b422cdSKonrad Rzeszutek Wilk void disable_cpufreq(void)
93a7b422cdSKonrad Rzeszutek Wilk {
94a7b422cdSKonrad Rzeszutek Wilk 	off = 1;
95a7b422cdSKonrad Rzeszutek Wilk }
961da177e4SLinus Torvalds static LIST_HEAD(cpufreq_governor_list);
973fc54d37Sakpm@osdl.org static DEFINE_MUTEX(cpufreq_governor_mutex);
981da177e4SLinus Torvalds 
994d5dcc42SViresh Kumar bool have_governor_per_policy(void)
1004d5dcc42SViresh Kumar {
1010b981e70SViresh Kumar 	return !!(cpufreq_driver->flags & CPUFREQ_HAVE_GOVERNOR_PER_POLICY);
1024d5dcc42SViresh Kumar }
1033f869d6dSViresh Kumar EXPORT_SYMBOL_GPL(have_governor_per_policy);
1044d5dcc42SViresh Kumar 
105944e9a03SViresh Kumar struct kobject *get_governor_parent_kobj(struct cpufreq_policy *policy)
106944e9a03SViresh Kumar {
107944e9a03SViresh Kumar 	if (have_governor_per_policy())
108944e9a03SViresh Kumar 		return &policy->kobj;
109944e9a03SViresh Kumar 	else
110944e9a03SViresh Kumar 		return cpufreq_global_kobject;
111944e9a03SViresh Kumar }
112944e9a03SViresh Kumar EXPORT_SYMBOL_GPL(get_governor_parent_kobj);
113944e9a03SViresh Kumar 
11472a4ce34SViresh Kumar static inline u64 get_cpu_idle_time_jiffy(unsigned int cpu, u64 *wall)
11572a4ce34SViresh Kumar {
11672a4ce34SViresh Kumar 	u64 idle_time;
11772a4ce34SViresh Kumar 	u64 cur_wall_time;
11872a4ce34SViresh Kumar 	u64 busy_time;
11972a4ce34SViresh Kumar 
12072a4ce34SViresh Kumar 	cur_wall_time = jiffies64_to_cputime64(get_jiffies_64());
12172a4ce34SViresh Kumar 
12272a4ce34SViresh Kumar 	busy_time = kcpustat_cpu(cpu).cpustat[CPUTIME_USER];
12372a4ce34SViresh Kumar 	busy_time += kcpustat_cpu(cpu).cpustat[CPUTIME_SYSTEM];
12472a4ce34SViresh Kumar 	busy_time += kcpustat_cpu(cpu).cpustat[CPUTIME_IRQ];
12572a4ce34SViresh Kumar 	busy_time += kcpustat_cpu(cpu).cpustat[CPUTIME_SOFTIRQ];
12672a4ce34SViresh Kumar 	busy_time += kcpustat_cpu(cpu).cpustat[CPUTIME_STEAL];
12772a4ce34SViresh Kumar 	busy_time += kcpustat_cpu(cpu).cpustat[CPUTIME_NICE];
12872a4ce34SViresh Kumar 
12972a4ce34SViresh Kumar 	idle_time = cur_wall_time - busy_time;
13072a4ce34SViresh Kumar 	if (wall)
13172a4ce34SViresh Kumar 		*wall = cputime_to_usecs(cur_wall_time);
13272a4ce34SViresh Kumar 
13372a4ce34SViresh Kumar 	return cputime_to_usecs(idle_time);
13472a4ce34SViresh Kumar }
13572a4ce34SViresh Kumar 
13672a4ce34SViresh Kumar u64 get_cpu_idle_time(unsigned int cpu, u64 *wall, int io_busy)
13772a4ce34SViresh Kumar {
13872a4ce34SViresh Kumar 	u64 idle_time = get_cpu_idle_time_us(cpu, io_busy ? wall : NULL);
13972a4ce34SViresh Kumar 
14072a4ce34SViresh Kumar 	if (idle_time == -1ULL)
14172a4ce34SViresh Kumar 		return get_cpu_idle_time_jiffy(cpu, wall);
14272a4ce34SViresh Kumar 	else if (!io_busy)
14372a4ce34SViresh Kumar 		idle_time += get_cpu_iowait_time_us(cpu, wall);
14472a4ce34SViresh Kumar 
14572a4ce34SViresh Kumar 	return idle_time;
14672a4ce34SViresh Kumar }
14772a4ce34SViresh Kumar EXPORT_SYMBOL_GPL(get_cpu_idle_time);
14872a4ce34SViresh Kumar 
14970e9e778SViresh Kumar /*
15070e9e778SViresh Kumar  * This is a generic cpufreq init() routine which can be used by cpufreq
15170e9e778SViresh Kumar  * drivers of SMP systems. It will do following:
15270e9e778SViresh Kumar  * - validate & show freq table passed
15370e9e778SViresh Kumar  * - set policies transition latency
15470e9e778SViresh Kumar  * - policy->cpus with all possible CPUs
15570e9e778SViresh Kumar  */
15670e9e778SViresh Kumar int cpufreq_generic_init(struct cpufreq_policy *policy,
15770e9e778SViresh Kumar 		struct cpufreq_frequency_table *table,
15870e9e778SViresh Kumar 		unsigned int transition_latency)
15970e9e778SViresh Kumar {
16070e9e778SViresh Kumar 	int ret;
16170e9e778SViresh Kumar 
16270e9e778SViresh Kumar 	ret = cpufreq_table_validate_and_show(policy, table);
16370e9e778SViresh Kumar 	if (ret) {
16470e9e778SViresh Kumar 		pr_err("%s: invalid frequency table: %d\n", __func__, ret);
16570e9e778SViresh Kumar 		return ret;
16670e9e778SViresh Kumar 	}
16770e9e778SViresh Kumar 
16870e9e778SViresh Kumar 	policy->cpuinfo.transition_latency = transition_latency;
16970e9e778SViresh Kumar 
17070e9e778SViresh Kumar 	/*
17170e9e778SViresh Kumar 	 * The driver only supports the SMP configuartion where all processors
17270e9e778SViresh Kumar 	 * share the clock and voltage and clock.
17370e9e778SViresh Kumar 	 */
17470e9e778SViresh Kumar 	cpumask_setall(policy->cpus);
17570e9e778SViresh Kumar 
17670e9e778SViresh Kumar 	return 0;
17770e9e778SViresh Kumar }
17870e9e778SViresh Kumar EXPORT_SYMBOL_GPL(cpufreq_generic_init);
17970e9e778SViresh Kumar 
180652ed95dSViresh Kumar unsigned int cpufreq_generic_get(unsigned int cpu)
181652ed95dSViresh Kumar {
182652ed95dSViresh Kumar 	struct cpufreq_policy *policy = per_cpu(cpufreq_cpu_data, cpu);
183652ed95dSViresh Kumar 
184652ed95dSViresh Kumar 	if (!policy || IS_ERR(policy->clk)) {
185652ed95dSViresh Kumar 		pr_err("%s: No %s associated to cpu: %d\n", __func__,
186652ed95dSViresh Kumar 				policy ? "clk" : "policy", cpu);
187652ed95dSViresh Kumar 		return 0;
188652ed95dSViresh Kumar 	}
189652ed95dSViresh Kumar 
190652ed95dSViresh Kumar 	return clk_get_rate(policy->clk) / 1000;
191652ed95dSViresh Kumar }
192652ed95dSViresh Kumar EXPORT_SYMBOL_GPL(cpufreq_generic_get);
193652ed95dSViresh Kumar 
1946eed9404SViresh Kumar struct cpufreq_policy *cpufreq_cpu_get(unsigned int cpu)
1951da177e4SLinus Torvalds {
1966eed9404SViresh Kumar 	struct cpufreq_policy *policy = NULL;
1971da177e4SLinus Torvalds 	unsigned long flags;
1981da177e4SLinus Torvalds 
1996eed9404SViresh Kumar 	if (cpufreq_disabled() || (cpu >= nr_cpu_ids))
2006eed9404SViresh Kumar 		return NULL;
2016eed9404SViresh Kumar 
2026eed9404SViresh Kumar 	if (!down_read_trylock(&cpufreq_rwsem))
2036eed9404SViresh Kumar 		return NULL;
2041da177e4SLinus Torvalds 
2051da177e4SLinus Torvalds 	/* get the cpufreq driver */
2060d1857a1SNathan Zimmer 	read_lock_irqsave(&cpufreq_driver_lock, flags);
2071da177e4SLinus Torvalds 
2086eed9404SViresh Kumar 	if (cpufreq_driver) {
2091da177e4SLinus Torvalds 		/* get the CPU */
2103a3e9e06SViresh Kumar 		policy = per_cpu(cpufreq_cpu_data, cpu);
2116eed9404SViresh Kumar 		if (policy)
2126eed9404SViresh Kumar 			kobject_get(&policy->kobj);
2136eed9404SViresh Kumar 	}
2146eed9404SViresh Kumar 
2156eed9404SViresh Kumar 	read_unlock_irqrestore(&cpufreq_driver_lock, flags);
2161da177e4SLinus Torvalds 
2173a3e9e06SViresh Kumar 	if (!policy)
2186eed9404SViresh Kumar 		up_read(&cpufreq_rwsem);
2191da177e4SLinus Torvalds 
2203a3e9e06SViresh Kumar 	return policy;
221a9144436SStephen Boyd }
2221da177e4SLinus Torvalds EXPORT_SYMBOL_GPL(cpufreq_cpu_get);
2231da177e4SLinus Torvalds 
2243a3e9e06SViresh Kumar void cpufreq_cpu_put(struct cpufreq_policy *policy)
225a9144436SStephen Boyd {
226d5aaffa9SDirk Brandewie 	if (cpufreq_disabled())
227d5aaffa9SDirk Brandewie 		return;
228d5aaffa9SDirk Brandewie 
2296eed9404SViresh Kumar 	kobject_put(&policy->kobj);
2306eed9404SViresh Kumar 	up_read(&cpufreq_rwsem);
231a9144436SStephen Boyd }
2321da177e4SLinus Torvalds EXPORT_SYMBOL_GPL(cpufreq_cpu_put);
2331da177e4SLinus Torvalds 
2341da177e4SLinus Torvalds /*********************************************************************
2351da177e4SLinus Torvalds  *            EXTERNALLY AFFECTING FREQUENCY CHANGES                 *
2361da177e4SLinus Torvalds  *********************************************************************/
2371da177e4SLinus Torvalds 
2381da177e4SLinus Torvalds /**
2391da177e4SLinus Torvalds  * adjust_jiffies - adjust the system "loops_per_jiffy"
2401da177e4SLinus Torvalds  *
2411da177e4SLinus Torvalds  * This function alters the system "loops_per_jiffy" for the clock
2421da177e4SLinus Torvalds  * speed change. Note that loops_per_jiffy cannot be updated on SMP
2431da177e4SLinus Torvalds  * systems as each CPU might be scaled differently. So, use the arch
2441da177e4SLinus Torvalds  * per-CPU loops_per_jiffy value wherever possible.
2451da177e4SLinus Torvalds  */
2461da177e4SLinus Torvalds #ifndef CONFIG_SMP
2471da177e4SLinus Torvalds static unsigned long l_p_j_ref;
2481da177e4SLinus Torvalds static unsigned int l_p_j_ref_freq;
2491da177e4SLinus Torvalds 
250858119e1SArjan van de Ven static void adjust_jiffies(unsigned long val, struct cpufreq_freqs *ci)
2511da177e4SLinus Torvalds {
2521da177e4SLinus Torvalds 	if (ci->flags & CPUFREQ_CONST_LOOPS)
2531da177e4SLinus Torvalds 		return;
2541da177e4SLinus Torvalds 
2551da177e4SLinus Torvalds 	if (!l_p_j_ref_freq) {
2561da177e4SLinus Torvalds 		l_p_j_ref = loops_per_jiffy;
2571da177e4SLinus Torvalds 		l_p_j_ref_freq = ci->old;
2582d06d8c4SDominik Brodowski 		pr_debug("saving %lu as reference value for loops_per_jiffy; "
259e08f5f5bSGautham R Shenoy 			"freq is %u kHz\n", l_p_j_ref, l_p_j_ref_freq);
2601da177e4SLinus Torvalds 	}
261d08de0c1SAfzal Mohammed 	if ((val == CPUFREQ_POSTCHANGE && ci->old != ci->new) ||
26242d4dc3fSBenjamin Herrenschmidt 	    (val == CPUFREQ_RESUMECHANGE || val == CPUFREQ_SUSPENDCHANGE)) {
263e08f5f5bSGautham R Shenoy 		loops_per_jiffy = cpufreq_scale(l_p_j_ref, l_p_j_ref_freq,
264e08f5f5bSGautham R Shenoy 								ci->new);
2652d06d8c4SDominik Brodowski 		pr_debug("scaling loops_per_jiffy to %lu "
266e08f5f5bSGautham R Shenoy 			"for frequency %u kHz\n", loops_per_jiffy, ci->new);
2671da177e4SLinus Torvalds 	}
2681da177e4SLinus Torvalds }
2691da177e4SLinus Torvalds #else
270e08f5f5bSGautham R Shenoy static inline void adjust_jiffies(unsigned long val, struct cpufreq_freqs *ci)
271e08f5f5bSGautham R Shenoy {
272e08f5f5bSGautham R Shenoy 	return;
273e08f5f5bSGautham R Shenoy }
2741da177e4SLinus Torvalds #endif
2751da177e4SLinus Torvalds 
2760956df9cSViresh Kumar static void __cpufreq_notify_transition(struct cpufreq_policy *policy,
277b43a7ffbSViresh Kumar 		struct cpufreq_freqs *freqs, unsigned int state)
2781da177e4SLinus Torvalds {
2791da177e4SLinus Torvalds 	BUG_ON(irqs_disabled());
2801da177e4SLinus Torvalds 
281d5aaffa9SDirk Brandewie 	if (cpufreq_disabled())
282d5aaffa9SDirk Brandewie 		return;
283d5aaffa9SDirk Brandewie 
2841c3d85ddSRafael J. Wysocki 	freqs->flags = cpufreq_driver->flags;
2852d06d8c4SDominik Brodowski 	pr_debug("notification %u of frequency transition to %u kHz\n",
286e4472cb3SDave Jones 		state, freqs->new);
2871da177e4SLinus Torvalds 
2881da177e4SLinus Torvalds 	switch (state) {
289e4472cb3SDave Jones 
2901da177e4SLinus Torvalds 	case CPUFREQ_PRECHANGE:
291e4472cb3SDave Jones 		/* detect if the driver reported a value as "old frequency"
292e4472cb3SDave Jones 		 * which is not equal to what the cpufreq core thinks is
293e4472cb3SDave Jones 		 * "old frequency".
2941da177e4SLinus Torvalds 		 */
2951c3d85ddSRafael J. Wysocki 		if (!(cpufreq_driver->flags & CPUFREQ_CONST_LOOPS)) {
296e4472cb3SDave Jones 			if ((policy) && (policy->cpu == freqs->cpu) &&
297e4472cb3SDave Jones 			    (policy->cur) && (policy->cur != freqs->old)) {
2982d06d8c4SDominik Brodowski 				pr_debug("Warning: CPU frequency is"
299e4472cb3SDave Jones 					" %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);
3112d06d8c4SDominik Brodowski 		pr_debug("FREQ: %lu - CPU: %lu", (unsigned long)freqs->new,
3126f4f2723SThomas Renninger 			(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  */
330b43a7ffbSViresh Kumar 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 EXPORT_SYMBOL_GPL(cpufreq_notify_transition);
3371da177e4SLinus Torvalds 
338f7ba3b41SViresh Kumar /* Do post notifications when there are chances that transition has failed */
339f7ba3b41SViresh Kumar void cpufreq_notify_post_transition(struct cpufreq_policy *policy,
340f7ba3b41SViresh Kumar 		struct cpufreq_freqs *freqs, int transition_failed)
341f7ba3b41SViresh Kumar {
342f7ba3b41SViresh Kumar 	cpufreq_notify_transition(policy, freqs, CPUFREQ_POSTCHANGE);
343f7ba3b41SViresh Kumar 	if (!transition_failed)
344f7ba3b41SViresh Kumar 		return;
345f7ba3b41SViresh Kumar 
346f7ba3b41SViresh Kumar 	swap(freqs->old, freqs->new);
347f7ba3b41SViresh Kumar 	cpufreq_notify_transition(policy, freqs, CPUFREQ_PRECHANGE);
348f7ba3b41SViresh Kumar 	cpufreq_notify_transition(policy, freqs, CPUFREQ_POSTCHANGE);
349f7ba3b41SViresh Kumar }
350f7ba3b41SViresh Kumar EXPORT_SYMBOL_GPL(cpufreq_notify_post_transition);
351f7ba3b41SViresh Kumar 
3521da177e4SLinus Torvalds 
3531da177e4SLinus Torvalds /*********************************************************************
3541da177e4SLinus Torvalds  *                          SYSFS INTERFACE                          *
3551da177e4SLinus Torvalds  *********************************************************************/
3568a5c74a1SRashika Kheria static ssize_t show_boost(struct kobject *kobj,
3576f19efc0SLukasz Majewski 				 struct attribute *attr, char *buf)
3586f19efc0SLukasz Majewski {
3596f19efc0SLukasz Majewski 	return sprintf(buf, "%d\n", cpufreq_driver->boost_enabled);
3606f19efc0SLukasz Majewski }
3616f19efc0SLukasz Majewski 
3626f19efc0SLukasz Majewski static ssize_t store_boost(struct kobject *kobj, struct attribute *attr,
3636f19efc0SLukasz Majewski 				  const char *buf, size_t count)
3646f19efc0SLukasz Majewski {
3656f19efc0SLukasz Majewski 	int ret, enable;
3666f19efc0SLukasz Majewski 
3676f19efc0SLukasz Majewski 	ret = sscanf(buf, "%d", &enable);
3686f19efc0SLukasz Majewski 	if (ret != 1 || enable < 0 || enable > 1)
3696f19efc0SLukasz Majewski 		return -EINVAL;
3706f19efc0SLukasz Majewski 
3716f19efc0SLukasz Majewski 	if (cpufreq_boost_trigger_state(enable)) {
3726f19efc0SLukasz Majewski 		pr_err("%s: Cannot %s BOOST!\n", __func__,
3736f19efc0SLukasz Majewski 		       enable ? "enable" : "disable");
3746f19efc0SLukasz Majewski 		return -EINVAL;
3756f19efc0SLukasz Majewski 	}
3766f19efc0SLukasz Majewski 
3776f19efc0SLukasz Majewski 	pr_debug("%s: cpufreq BOOST %s\n", __func__,
3786f19efc0SLukasz Majewski 		 enable ? "enabled" : "disabled");
3796f19efc0SLukasz Majewski 
3806f19efc0SLukasz Majewski 	return count;
3816f19efc0SLukasz Majewski }
3826f19efc0SLukasz Majewski define_one_global_rw(boost);
3831da177e4SLinus Torvalds 
3843bcb09a3SJeremy Fitzhardinge static struct cpufreq_governor *__find_governor(const char *str_governor)
3853bcb09a3SJeremy Fitzhardinge {
3863bcb09a3SJeremy Fitzhardinge 	struct cpufreq_governor *t;
3873bcb09a3SJeremy Fitzhardinge 
3883bcb09a3SJeremy Fitzhardinge 	list_for_each_entry(t, &cpufreq_governor_list, governor_list)
3893bcb09a3SJeremy Fitzhardinge 		if (!strnicmp(str_governor, t->name, CPUFREQ_NAME_LEN))
3903bcb09a3SJeremy Fitzhardinge 			return t;
3913bcb09a3SJeremy Fitzhardinge 
3923bcb09a3SJeremy Fitzhardinge 	return NULL;
3933bcb09a3SJeremy Fitzhardinge }
3943bcb09a3SJeremy Fitzhardinge 
3951da177e4SLinus Torvalds /**
3961da177e4SLinus Torvalds  * cpufreq_parse_governor - parse a governor string
3971da177e4SLinus Torvalds  */
3981da177e4SLinus Torvalds static int cpufreq_parse_governor(char *str_governor, unsigned int *policy,
3991da177e4SLinus Torvalds 				struct cpufreq_governor **governor)
4001da177e4SLinus Torvalds {
4013bcb09a3SJeremy Fitzhardinge 	int err = -EINVAL;
4023bcb09a3SJeremy Fitzhardinge 
4031c3d85ddSRafael J. Wysocki 	if (!cpufreq_driver)
4043bcb09a3SJeremy Fitzhardinge 		goto out;
4053bcb09a3SJeremy Fitzhardinge 
4061c3d85ddSRafael J. Wysocki 	if (cpufreq_driver->setpolicy) {
4071da177e4SLinus Torvalds 		if (!strnicmp(str_governor, "performance", CPUFREQ_NAME_LEN)) {
4081da177e4SLinus Torvalds 			*policy = CPUFREQ_POLICY_PERFORMANCE;
4093bcb09a3SJeremy Fitzhardinge 			err = 0;
410e08f5f5bSGautham R Shenoy 		} else if (!strnicmp(str_governor, "powersave",
411e08f5f5bSGautham R Shenoy 						CPUFREQ_NAME_LEN)) {
4121da177e4SLinus Torvalds 			*policy = CPUFREQ_POLICY_POWERSAVE;
4133bcb09a3SJeremy Fitzhardinge 			err = 0;
4141da177e4SLinus Torvalds 		}
4159c0ebcf7SViresh Kumar 	} else if (has_target()) {
4161da177e4SLinus Torvalds 		struct cpufreq_governor *t;
4173bcb09a3SJeremy Fitzhardinge 
4183fc54d37Sakpm@osdl.org 		mutex_lock(&cpufreq_governor_mutex);
4193bcb09a3SJeremy Fitzhardinge 
4203bcb09a3SJeremy Fitzhardinge 		t = __find_governor(str_governor);
4213bcb09a3SJeremy Fitzhardinge 
422ea714970SJeremy Fitzhardinge 		if (t == NULL) {
423ea714970SJeremy Fitzhardinge 			int ret;
424ea714970SJeremy Fitzhardinge 
425ea714970SJeremy Fitzhardinge 			mutex_unlock(&cpufreq_governor_mutex);
4261a8e1463SKees Cook 			ret = request_module("cpufreq_%s", str_governor);
427ea714970SJeremy Fitzhardinge 			mutex_lock(&cpufreq_governor_mutex);
428ea714970SJeremy Fitzhardinge 
429ea714970SJeremy Fitzhardinge 			if (ret == 0)
430ea714970SJeremy Fitzhardinge 				t = __find_governor(str_governor);
431ea714970SJeremy Fitzhardinge 		}
432ea714970SJeremy Fitzhardinge 
4333bcb09a3SJeremy Fitzhardinge 		if (t != NULL) {
4341da177e4SLinus Torvalds 			*governor = t;
4353bcb09a3SJeremy Fitzhardinge 			err = 0;
4361da177e4SLinus Torvalds 		}
4373bcb09a3SJeremy Fitzhardinge 
4383bcb09a3SJeremy Fitzhardinge 		mutex_unlock(&cpufreq_governor_mutex);
4391da177e4SLinus Torvalds 	}
4401da177e4SLinus Torvalds out:
4413bcb09a3SJeremy Fitzhardinge 	return err;
4421da177e4SLinus Torvalds }
4431da177e4SLinus Torvalds 
4441da177e4SLinus Torvalds /**
445e08f5f5bSGautham R Shenoy  * cpufreq_per_cpu_attr_read() / show_##file_name() -
446e08f5f5bSGautham R Shenoy  * print out cpufreq information
4471da177e4SLinus Torvalds  *
4481da177e4SLinus Torvalds  * Write out information from cpufreq_driver->policy[cpu]; object must be
4491da177e4SLinus Torvalds  * "unsigned int".
4501da177e4SLinus Torvalds  */
4511da177e4SLinus Torvalds 
4521da177e4SLinus Torvalds #define show_one(file_name, object)			\
4531da177e4SLinus Torvalds static ssize_t show_##file_name				\
4541da177e4SLinus Torvalds (struct cpufreq_policy *policy, char *buf)		\
4551da177e4SLinus Torvalds {							\
4561da177e4SLinus Torvalds 	return sprintf(buf, "%u\n", policy->object);	\
4571da177e4SLinus Torvalds }
4581da177e4SLinus Torvalds 
4591da177e4SLinus Torvalds show_one(cpuinfo_min_freq, cpuinfo.min_freq);
4601da177e4SLinus Torvalds show_one(cpuinfo_max_freq, cpuinfo.max_freq);
461ed129784SThomas Renninger show_one(cpuinfo_transition_latency, cpuinfo.transition_latency);
4621da177e4SLinus Torvalds show_one(scaling_min_freq, min);
4631da177e4SLinus Torvalds show_one(scaling_max_freq, max);
4641da177e4SLinus Torvalds show_one(scaling_cur_freq, cur);
4651da177e4SLinus Torvalds 
466037ce839SViresh Kumar static int cpufreq_set_policy(struct cpufreq_policy *policy,
4673a3e9e06SViresh Kumar 				struct cpufreq_policy *new_policy);
4687970e08bSThomas Renninger 
4691da177e4SLinus Torvalds /**
4701da177e4SLinus Torvalds  * cpufreq_per_cpu_attr_write() / store_##file_name() - sysfs write access
4711da177e4SLinus Torvalds  */
4721da177e4SLinus Torvalds #define store_one(file_name, object)			\
4731da177e4SLinus Torvalds static ssize_t store_##file_name					\
4741da177e4SLinus Torvalds (struct cpufreq_policy *policy, const char *buf, size_t count)		\
4751da177e4SLinus Torvalds {									\
4765136fa56SSrivatsa S. Bhat 	int ret;							\
4771da177e4SLinus Torvalds 	struct cpufreq_policy new_policy;				\
4781da177e4SLinus Torvalds 									\
4791da177e4SLinus Torvalds 	ret = cpufreq_get_policy(&new_policy, policy->cpu);		\
4801da177e4SLinus Torvalds 	if (ret)							\
4811da177e4SLinus Torvalds 		return -EINVAL;						\
4821da177e4SLinus Torvalds 									\
4831da177e4SLinus Torvalds 	ret = sscanf(buf, "%u", &new_policy.object);			\
4841da177e4SLinus Torvalds 	if (ret != 1)							\
4851da177e4SLinus Torvalds 		return -EINVAL;						\
4861da177e4SLinus Torvalds 									\
487037ce839SViresh Kumar 	ret = cpufreq_set_policy(policy, &new_policy);		\
4887970e08bSThomas Renninger 	policy->user_policy.object = policy->object;			\
4891da177e4SLinus Torvalds 									\
4901da177e4SLinus Torvalds 	return ret ? ret : count;					\
4911da177e4SLinus Torvalds }
4921da177e4SLinus Torvalds 
4931da177e4SLinus Torvalds store_one(scaling_min_freq, min);
4941da177e4SLinus Torvalds store_one(scaling_max_freq, max);
4951da177e4SLinus Torvalds 
4961da177e4SLinus Torvalds /**
4971da177e4SLinus Torvalds  * show_cpuinfo_cur_freq - current CPU frequency as detected by hardware
4981da177e4SLinus Torvalds  */
499e08f5f5bSGautham R Shenoy static ssize_t show_cpuinfo_cur_freq(struct cpufreq_policy *policy,
500e08f5f5bSGautham R Shenoy 					char *buf)
5011da177e4SLinus Torvalds {
5025a01f2e8SVenkatesh Pallipadi 	unsigned int cur_freq = __cpufreq_get(policy->cpu);
5031da177e4SLinus Torvalds 	if (!cur_freq)
5041da177e4SLinus Torvalds 		return sprintf(buf, "<unknown>");
5051da177e4SLinus Torvalds 	return sprintf(buf, "%u\n", cur_freq);
5061da177e4SLinus Torvalds }
5071da177e4SLinus Torvalds 
5081da177e4SLinus Torvalds /**
5091da177e4SLinus Torvalds  * show_scaling_governor - show the current policy for the specified CPU
5101da177e4SLinus Torvalds  */
511905d77cdSDave Jones static ssize_t show_scaling_governor(struct cpufreq_policy *policy, char *buf)
5121da177e4SLinus Torvalds {
5131da177e4SLinus Torvalds 	if (policy->policy == CPUFREQ_POLICY_POWERSAVE)
5141da177e4SLinus Torvalds 		return sprintf(buf, "powersave\n");
5151da177e4SLinus Torvalds 	else if (policy->policy == CPUFREQ_POLICY_PERFORMANCE)
5161da177e4SLinus Torvalds 		return sprintf(buf, "performance\n");
5171da177e4SLinus Torvalds 	else if (policy->governor)
5184b972f0bSviresh kumar 		return scnprintf(buf, CPUFREQ_NAME_PLEN, "%s\n",
51929464f28SDave Jones 				policy->governor->name);
5201da177e4SLinus Torvalds 	return -EINVAL;
5211da177e4SLinus Torvalds }
5221da177e4SLinus Torvalds 
5231da177e4SLinus Torvalds /**
5241da177e4SLinus Torvalds  * store_scaling_governor - store policy for the specified CPU
5251da177e4SLinus Torvalds  */
5261da177e4SLinus Torvalds static ssize_t store_scaling_governor(struct cpufreq_policy *policy,
5271da177e4SLinus Torvalds 					const char *buf, size_t count)
5281da177e4SLinus Torvalds {
5295136fa56SSrivatsa S. Bhat 	int ret;
5301da177e4SLinus Torvalds 	char	str_governor[16];
5311da177e4SLinus Torvalds 	struct cpufreq_policy new_policy;
5321da177e4SLinus Torvalds 
5331da177e4SLinus Torvalds 	ret = cpufreq_get_policy(&new_policy, policy->cpu);
5341da177e4SLinus Torvalds 	if (ret)
5351da177e4SLinus Torvalds 		return ret;
5361da177e4SLinus Torvalds 
5371da177e4SLinus Torvalds 	ret = sscanf(buf, "%15s", str_governor);
5381da177e4SLinus Torvalds 	if (ret != 1)
5391da177e4SLinus Torvalds 		return -EINVAL;
5401da177e4SLinus Torvalds 
541e08f5f5bSGautham R Shenoy 	if (cpufreq_parse_governor(str_governor, &new_policy.policy,
542e08f5f5bSGautham R Shenoy 						&new_policy.governor))
5431da177e4SLinus Torvalds 		return -EINVAL;
5441da177e4SLinus Torvalds 
545037ce839SViresh Kumar 	ret = cpufreq_set_policy(policy, &new_policy);
5467970e08bSThomas Renninger 
5477970e08bSThomas Renninger 	policy->user_policy.policy = policy->policy;
5487970e08bSThomas Renninger 	policy->user_policy.governor = policy->governor;
5497970e08bSThomas Renninger 
550e08f5f5bSGautham R Shenoy 	if (ret)
551e08f5f5bSGautham R Shenoy 		return ret;
552e08f5f5bSGautham R Shenoy 	else
553e08f5f5bSGautham R Shenoy 		return count;
5541da177e4SLinus Torvalds }
5551da177e4SLinus Torvalds 
5561da177e4SLinus Torvalds /**
5571da177e4SLinus Torvalds  * show_scaling_driver - show the cpufreq driver currently loaded
5581da177e4SLinus Torvalds  */
5591da177e4SLinus Torvalds static ssize_t show_scaling_driver(struct cpufreq_policy *policy, char *buf)
5601da177e4SLinus Torvalds {
5611c3d85ddSRafael J. Wysocki 	return scnprintf(buf, CPUFREQ_NAME_PLEN, "%s\n", cpufreq_driver->name);
5621da177e4SLinus Torvalds }
5631da177e4SLinus Torvalds 
5641da177e4SLinus Torvalds /**
5651da177e4SLinus Torvalds  * show_scaling_available_governors - show the available CPUfreq governors
5661da177e4SLinus Torvalds  */
5671da177e4SLinus Torvalds static ssize_t show_scaling_available_governors(struct cpufreq_policy *policy,
5681da177e4SLinus Torvalds 						char *buf)
5691da177e4SLinus Torvalds {
5701da177e4SLinus Torvalds 	ssize_t i = 0;
5711da177e4SLinus Torvalds 	struct cpufreq_governor *t;
5721da177e4SLinus Torvalds 
5739c0ebcf7SViresh Kumar 	if (!has_target()) {
5741da177e4SLinus Torvalds 		i += sprintf(buf, "performance powersave");
5751da177e4SLinus Torvalds 		goto out;
5761da177e4SLinus Torvalds 	}
5771da177e4SLinus Torvalds 
5781da177e4SLinus Torvalds 	list_for_each_entry(t, &cpufreq_governor_list, governor_list) {
57929464f28SDave Jones 		if (i >= (ssize_t) ((PAGE_SIZE / sizeof(char))
58029464f28SDave Jones 		    - (CPUFREQ_NAME_LEN + 2)))
5811da177e4SLinus Torvalds 			goto out;
5824b972f0bSviresh kumar 		i += scnprintf(&buf[i], CPUFREQ_NAME_PLEN, "%s ", t->name);
5831da177e4SLinus Torvalds 	}
5841da177e4SLinus Torvalds out:
5851da177e4SLinus Torvalds 	i += sprintf(&buf[i], "\n");
5861da177e4SLinus Torvalds 	return i;
5871da177e4SLinus Torvalds }
588e8628dd0SDarrick J. Wong 
589f4fd3797SLan Tianyu ssize_t cpufreq_show_cpus(const struct cpumask *mask, char *buf)
5901da177e4SLinus Torvalds {
5911da177e4SLinus Torvalds 	ssize_t i = 0;
5921da177e4SLinus Torvalds 	unsigned int cpu;
5931da177e4SLinus Torvalds 
594835481d9SRusty Russell 	for_each_cpu(cpu, mask) {
5951da177e4SLinus Torvalds 		if (i)
5961da177e4SLinus Torvalds 			i += scnprintf(&buf[i], (PAGE_SIZE - i - 2), " ");
5971da177e4SLinus Torvalds 		i += scnprintf(&buf[i], (PAGE_SIZE - i - 2), "%u", cpu);
5981da177e4SLinus Torvalds 		if (i >= (PAGE_SIZE - 5))
5991da177e4SLinus Torvalds 			break;
6001da177e4SLinus Torvalds 	}
6011da177e4SLinus Torvalds 	i += sprintf(&buf[i], "\n");
6021da177e4SLinus Torvalds 	return i;
6031da177e4SLinus Torvalds }
604f4fd3797SLan Tianyu EXPORT_SYMBOL_GPL(cpufreq_show_cpus);
6051da177e4SLinus Torvalds 
606e8628dd0SDarrick J. Wong /**
607e8628dd0SDarrick J. Wong  * show_related_cpus - show the CPUs affected by each transition even if
608e8628dd0SDarrick J. Wong  * hw coordination is in use
609e8628dd0SDarrick J. Wong  */
610e8628dd0SDarrick J. Wong static ssize_t show_related_cpus(struct cpufreq_policy *policy, char *buf)
611e8628dd0SDarrick J. Wong {
612f4fd3797SLan Tianyu 	return cpufreq_show_cpus(policy->related_cpus, buf);
613e8628dd0SDarrick J. Wong }
614e8628dd0SDarrick J. Wong 
615e8628dd0SDarrick J. Wong /**
616e8628dd0SDarrick J. Wong  * show_affected_cpus - show the CPUs affected by each transition
617e8628dd0SDarrick J. Wong  */
618e8628dd0SDarrick J. Wong static ssize_t show_affected_cpus(struct cpufreq_policy *policy, char *buf)
619e8628dd0SDarrick J. Wong {
620f4fd3797SLan Tianyu 	return cpufreq_show_cpus(policy->cpus, buf);
621e8628dd0SDarrick J. Wong }
622e8628dd0SDarrick J. Wong 
6239e76988eSVenki Pallipadi static ssize_t store_scaling_setspeed(struct cpufreq_policy *policy,
6249e76988eSVenki Pallipadi 					const char *buf, size_t count)
6259e76988eSVenki Pallipadi {
6269e76988eSVenki Pallipadi 	unsigned int freq = 0;
6279e76988eSVenki Pallipadi 	unsigned int ret;
6289e76988eSVenki Pallipadi 
629879000f9SCHIKAMA masaki 	if (!policy->governor || !policy->governor->store_setspeed)
6309e76988eSVenki Pallipadi 		return -EINVAL;
6319e76988eSVenki Pallipadi 
6329e76988eSVenki Pallipadi 	ret = sscanf(buf, "%u", &freq);
6339e76988eSVenki Pallipadi 	if (ret != 1)
6349e76988eSVenki Pallipadi 		return -EINVAL;
6359e76988eSVenki Pallipadi 
6369e76988eSVenki Pallipadi 	policy->governor->store_setspeed(policy, freq);
6379e76988eSVenki Pallipadi 
6389e76988eSVenki Pallipadi 	return count;
6399e76988eSVenki Pallipadi }
6409e76988eSVenki Pallipadi 
6419e76988eSVenki Pallipadi static ssize_t show_scaling_setspeed(struct cpufreq_policy *policy, char *buf)
6429e76988eSVenki Pallipadi {
643879000f9SCHIKAMA masaki 	if (!policy->governor || !policy->governor->show_setspeed)
6449e76988eSVenki Pallipadi 		return sprintf(buf, "<unsupported>\n");
6459e76988eSVenki Pallipadi 
6469e76988eSVenki Pallipadi 	return policy->governor->show_setspeed(policy, buf);
6479e76988eSVenki Pallipadi }
6481da177e4SLinus Torvalds 
649e2f74f35SThomas Renninger /**
6508bf1ac72Sviresh kumar  * show_bios_limit - show the current cpufreq HW/BIOS limitation
651e2f74f35SThomas Renninger  */
652e2f74f35SThomas Renninger static ssize_t show_bios_limit(struct cpufreq_policy *policy, char *buf)
653e2f74f35SThomas Renninger {
654e2f74f35SThomas Renninger 	unsigned int limit;
655e2f74f35SThomas Renninger 	int ret;
6561c3d85ddSRafael J. Wysocki 	if (cpufreq_driver->bios_limit) {
6571c3d85ddSRafael J. Wysocki 		ret = cpufreq_driver->bios_limit(policy->cpu, &limit);
658e2f74f35SThomas Renninger 		if (!ret)
659e2f74f35SThomas Renninger 			return sprintf(buf, "%u\n", limit);
660e2f74f35SThomas Renninger 	}
661e2f74f35SThomas Renninger 	return sprintf(buf, "%u\n", policy->cpuinfo.max_freq);
662e2f74f35SThomas Renninger }
663e2f74f35SThomas Renninger 
6646dad2a29SBorislav Petkov cpufreq_freq_attr_ro_perm(cpuinfo_cur_freq, 0400);
6656dad2a29SBorislav Petkov cpufreq_freq_attr_ro(cpuinfo_min_freq);
6666dad2a29SBorislav Petkov cpufreq_freq_attr_ro(cpuinfo_max_freq);
6676dad2a29SBorislav Petkov cpufreq_freq_attr_ro(cpuinfo_transition_latency);
6686dad2a29SBorislav Petkov cpufreq_freq_attr_ro(scaling_available_governors);
6696dad2a29SBorislav Petkov cpufreq_freq_attr_ro(scaling_driver);
6706dad2a29SBorislav Petkov cpufreq_freq_attr_ro(scaling_cur_freq);
6716dad2a29SBorislav Petkov cpufreq_freq_attr_ro(bios_limit);
6726dad2a29SBorislav Petkov cpufreq_freq_attr_ro(related_cpus);
6736dad2a29SBorislav Petkov cpufreq_freq_attr_ro(affected_cpus);
6746dad2a29SBorislav Petkov cpufreq_freq_attr_rw(scaling_min_freq);
6756dad2a29SBorislav Petkov cpufreq_freq_attr_rw(scaling_max_freq);
6766dad2a29SBorislav Petkov cpufreq_freq_attr_rw(scaling_governor);
6776dad2a29SBorislav Petkov cpufreq_freq_attr_rw(scaling_setspeed);
6781da177e4SLinus Torvalds 
6791da177e4SLinus Torvalds static struct attribute *default_attrs[] = {
6801da177e4SLinus Torvalds 	&cpuinfo_min_freq.attr,
6811da177e4SLinus Torvalds 	&cpuinfo_max_freq.attr,
682ed129784SThomas Renninger 	&cpuinfo_transition_latency.attr,
6831da177e4SLinus Torvalds 	&scaling_min_freq.attr,
6841da177e4SLinus Torvalds 	&scaling_max_freq.attr,
6851da177e4SLinus Torvalds 	&affected_cpus.attr,
686e8628dd0SDarrick J. Wong 	&related_cpus.attr,
6871da177e4SLinus Torvalds 	&scaling_governor.attr,
6881da177e4SLinus Torvalds 	&scaling_driver.attr,
6891da177e4SLinus Torvalds 	&scaling_available_governors.attr,
6909e76988eSVenki Pallipadi 	&scaling_setspeed.attr,
6911da177e4SLinus Torvalds 	NULL
6921da177e4SLinus Torvalds };
6931da177e4SLinus Torvalds 
6941da177e4SLinus Torvalds #define to_policy(k) container_of(k, struct cpufreq_policy, kobj)
6951da177e4SLinus Torvalds #define to_attr(a) container_of(a, struct freq_attr, attr)
6961da177e4SLinus Torvalds 
6971da177e4SLinus Torvalds static ssize_t show(struct kobject *kobj, struct attribute *attr, char *buf)
6981da177e4SLinus Torvalds {
6991da177e4SLinus Torvalds 	struct cpufreq_policy *policy = to_policy(kobj);
7001da177e4SLinus Torvalds 	struct freq_attr *fattr = to_attr(attr);
7011b750e3bSViresh Kumar 	ssize_t ret;
7026eed9404SViresh Kumar 
7036eed9404SViresh Kumar 	if (!down_read_trylock(&cpufreq_rwsem))
7041b750e3bSViresh Kumar 		return -EINVAL;
7055a01f2e8SVenkatesh Pallipadi 
706ad7722daSviresh kumar 	down_read(&policy->rwsem);
7075a01f2e8SVenkatesh Pallipadi 
708e08f5f5bSGautham R Shenoy 	if (fattr->show)
709e08f5f5bSGautham R Shenoy 		ret = fattr->show(policy, buf);
710e08f5f5bSGautham R Shenoy 	else
711e08f5f5bSGautham R Shenoy 		ret = -EIO;
712e08f5f5bSGautham R Shenoy 
713ad7722daSviresh kumar 	up_read(&policy->rwsem);
7146eed9404SViresh Kumar 	up_read(&cpufreq_rwsem);
7151b750e3bSViresh Kumar 
7161da177e4SLinus Torvalds 	return ret;
7171da177e4SLinus Torvalds }
7181da177e4SLinus Torvalds 
7191da177e4SLinus Torvalds static ssize_t store(struct kobject *kobj, struct attribute *attr,
7201da177e4SLinus Torvalds 		     const char *buf, size_t count)
7211da177e4SLinus Torvalds {
7221da177e4SLinus Torvalds 	struct cpufreq_policy *policy = to_policy(kobj);
7231da177e4SLinus Torvalds 	struct freq_attr *fattr = to_attr(attr);
724a07530b4SDave Jones 	ssize_t ret = -EINVAL;
7256eed9404SViresh Kumar 
7264f750c93SSrivatsa S. Bhat 	get_online_cpus();
7274f750c93SSrivatsa S. Bhat 
7284f750c93SSrivatsa S. Bhat 	if (!cpu_online(policy->cpu))
7294f750c93SSrivatsa S. Bhat 		goto unlock;
7304f750c93SSrivatsa S. Bhat 
7316eed9404SViresh Kumar 	if (!down_read_trylock(&cpufreq_rwsem))
7324f750c93SSrivatsa S. Bhat 		goto unlock;
7335a01f2e8SVenkatesh Pallipadi 
734ad7722daSviresh kumar 	down_write(&policy->rwsem);
7355a01f2e8SVenkatesh Pallipadi 
736e08f5f5bSGautham R Shenoy 	if (fattr->store)
737e08f5f5bSGautham R Shenoy 		ret = fattr->store(policy, buf, count);
738e08f5f5bSGautham R Shenoy 	else
739e08f5f5bSGautham R Shenoy 		ret = -EIO;
740e08f5f5bSGautham R Shenoy 
741ad7722daSviresh kumar 	up_write(&policy->rwsem);
7426eed9404SViresh Kumar 
7436eed9404SViresh Kumar 	up_read(&cpufreq_rwsem);
7444f750c93SSrivatsa S. Bhat unlock:
7454f750c93SSrivatsa S. Bhat 	put_online_cpus();
7464f750c93SSrivatsa S. Bhat 
7471da177e4SLinus Torvalds 	return ret;
7481da177e4SLinus Torvalds }
7491da177e4SLinus Torvalds 
7501da177e4SLinus Torvalds static void cpufreq_sysfs_release(struct kobject *kobj)
7511da177e4SLinus Torvalds {
7521da177e4SLinus Torvalds 	struct cpufreq_policy *policy = to_policy(kobj);
7532d06d8c4SDominik Brodowski 	pr_debug("last reference is dropped\n");
7541da177e4SLinus Torvalds 	complete(&policy->kobj_unregister);
7551da177e4SLinus Torvalds }
7561da177e4SLinus Torvalds 
75752cf25d0SEmese Revfy static const struct sysfs_ops sysfs_ops = {
7581da177e4SLinus Torvalds 	.show	= show,
7591da177e4SLinus Torvalds 	.store	= store,
7601da177e4SLinus Torvalds };
7611da177e4SLinus Torvalds 
7621da177e4SLinus Torvalds static struct kobj_type ktype_cpufreq = {
7631da177e4SLinus Torvalds 	.sysfs_ops	= &sysfs_ops,
7641da177e4SLinus Torvalds 	.default_attrs	= default_attrs,
7651da177e4SLinus Torvalds 	.release	= cpufreq_sysfs_release,
7661da177e4SLinus Torvalds };
7671da177e4SLinus Torvalds 
7682361be23SViresh Kumar struct kobject *cpufreq_global_kobject;
7692361be23SViresh Kumar EXPORT_SYMBOL(cpufreq_global_kobject);
7702361be23SViresh Kumar 
7712361be23SViresh Kumar static int cpufreq_global_kobject_usage;
7722361be23SViresh Kumar 
7732361be23SViresh Kumar int cpufreq_get_global_kobject(void)
7742361be23SViresh Kumar {
7752361be23SViresh Kumar 	if (!cpufreq_global_kobject_usage++)
7762361be23SViresh Kumar 		return kobject_add(cpufreq_global_kobject,
7772361be23SViresh Kumar 				&cpu_subsys.dev_root->kobj, "%s", "cpufreq");
7782361be23SViresh Kumar 
7792361be23SViresh Kumar 	return 0;
7802361be23SViresh Kumar }
7812361be23SViresh Kumar EXPORT_SYMBOL(cpufreq_get_global_kobject);
7822361be23SViresh Kumar 
7832361be23SViresh Kumar void cpufreq_put_global_kobject(void)
7842361be23SViresh Kumar {
7852361be23SViresh Kumar 	if (!--cpufreq_global_kobject_usage)
7862361be23SViresh Kumar 		kobject_del(cpufreq_global_kobject);
7872361be23SViresh Kumar }
7882361be23SViresh Kumar EXPORT_SYMBOL(cpufreq_put_global_kobject);
7892361be23SViresh Kumar 
7902361be23SViresh Kumar int cpufreq_sysfs_create_file(const struct attribute *attr)
7912361be23SViresh Kumar {
7922361be23SViresh Kumar 	int ret = cpufreq_get_global_kobject();
7932361be23SViresh Kumar 
7942361be23SViresh Kumar 	if (!ret) {
7952361be23SViresh Kumar 		ret = sysfs_create_file(cpufreq_global_kobject, attr);
7962361be23SViresh Kumar 		if (ret)
7972361be23SViresh Kumar 			cpufreq_put_global_kobject();
7982361be23SViresh Kumar 	}
7992361be23SViresh Kumar 
8002361be23SViresh Kumar 	return ret;
8012361be23SViresh Kumar }
8022361be23SViresh Kumar EXPORT_SYMBOL(cpufreq_sysfs_create_file);
8032361be23SViresh Kumar 
8042361be23SViresh Kumar void cpufreq_sysfs_remove_file(const struct attribute *attr)
8052361be23SViresh Kumar {
8062361be23SViresh Kumar 	sysfs_remove_file(cpufreq_global_kobject, attr);
8072361be23SViresh Kumar 	cpufreq_put_global_kobject();
8082361be23SViresh Kumar }
8092361be23SViresh Kumar EXPORT_SYMBOL(cpufreq_sysfs_remove_file);
8102361be23SViresh Kumar 
81119d6f7ecSDave Jones /* symlink affected CPUs */
812308b60e7SViresh Kumar static int cpufreq_add_dev_symlink(struct cpufreq_policy *policy)
81319d6f7ecSDave Jones {
81419d6f7ecSDave Jones 	unsigned int j;
81519d6f7ecSDave Jones 	int ret = 0;
81619d6f7ecSDave Jones 
81719d6f7ecSDave Jones 	for_each_cpu(j, policy->cpus) {
8188a25a2fdSKay Sievers 		struct device *cpu_dev;
81919d6f7ecSDave Jones 
820308b60e7SViresh Kumar 		if (j == policy->cpu)
82119d6f7ecSDave Jones 			continue;
82219d6f7ecSDave Jones 
823e8fdde10SViresh Kumar 		pr_debug("Adding link for CPU: %u\n", j);
8248a25a2fdSKay Sievers 		cpu_dev = get_cpu_device(j);
8258a25a2fdSKay Sievers 		ret = sysfs_create_link(&cpu_dev->kobj, &policy->kobj,
82619d6f7ecSDave Jones 					"cpufreq");
82771c3461eSRafael J. Wysocki 		if (ret)
82871c3461eSRafael J. Wysocki 			break;
82919d6f7ecSDave Jones 	}
83019d6f7ecSDave Jones 	return ret;
83119d6f7ecSDave Jones }
83219d6f7ecSDave Jones 
833308b60e7SViresh Kumar static int cpufreq_add_dev_interface(struct cpufreq_policy *policy,
8348a25a2fdSKay Sievers 				     struct device *dev)
835909a694eSDave Jones {
836909a694eSDave Jones 	struct freq_attr **drv_attr;
837909a694eSDave Jones 	int ret = 0;
838909a694eSDave Jones 
839909a694eSDave Jones 	/* prepare interface data */
840909a694eSDave Jones 	ret = kobject_init_and_add(&policy->kobj, &ktype_cpufreq,
8418a25a2fdSKay Sievers 				   &dev->kobj, "cpufreq");
842909a694eSDave Jones 	if (ret)
843909a694eSDave Jones 		return ret;
844909a694eSDave Jones 
845909a694eSDave Jones 	/* set up files for this cpu device */
8461c3d85ddSRafael J. Wysocki 	drv_attr = cpufreq_driver->attr;
847909a694eSDave Jones 	while ((drv_attr) && (*drv_attr)) {
848909a694eSDave Jones 		ret = sysfs_create_file(&policy->kobj, &((*drv_attr)->attr));
849909a694eSDave Jones 		if (ret)
8501c3d85ddSRafael J. Wysocki 			goto err_out_kobj_put;
851909a694eSDave Jones 		drv_attr++;
852909a694eSDave Jones 	}
8531c3d85ddSRafael J. Wysocki 	if (cpufreq_driver->get) {
854909a694eSDave Jones 		ret = sysfs_create_file(&policy->kobj, &cpuinfo_cur_freq.attr);
855909a694eSDave Jones 		if (ret)
8561c3d85ddSRafael J. Wysocki 			goto err_out_kobj_put;
857909a694eSDave Jones 	}
8589c0ebcf7SViresh Kumar 	if (has_target()) {
859909a694eSDave Jones 		ret = sysfs_create_file(&policy->kobj, &scaling_cur_freq.attr);
860909a694eSDave Jones 		if (ret)
8611c3d85ddSRafael J. Wysocki 			goto err_out_kobj_put;
862909a694eSDave Jones 	}
8631c3d85ddSRafael J. Wysocki 	if (cpufreq_driver->bios_limit) {
864e2f74f35SThomas Renninger 		ret = sysfs_create_file(&policy->kobj, &bios_limit.attr);
865e2f74f35SThomas Renninger 		if (ret)
8661c3d85ddSRafael J. Wysocki 			goto err_out_kobj_put;
867e2f74f35SThomas Renninger 	}
868909a694eSDave Jones 
869308b60e7SViresh Kumar 	ret = cpufreq_add_dev_symlink(policy);
870ecf7e461SDave Jones 	if (ret)
871ecf7e461SDave Jones 		goto err_out_kobj_put;
872ecf7e461SDave Jones 
873e18f1682SSrivatsa S. Bhat 	return ret;
874e18f1682SSrivatsa S. Bhat 
875e18f1682SSrivatsa S. Bhat err_out_kobj_put:
876e18f1682SSrivatsa S. Bhat 	kobject_put(&policy->kobj);
877e18f1682SSrivatsa S. Bhat 	wait_for_completion(&policy->kobj_unregister);
878e18f1682SSrivatsa S. Bhat 	return ret;
879e18f1682SSrivatsa S. Bhat }
880e18f1682SSrivatsa S. Bhat 
881e18f1682SSrivatsa S. Bhat static void cpufreq_init_policy(struct cpufreq_policy *policy)
882e18f1682SSrivatsa S. Bhat {
8836e2c89d1Sviresh kumar 	struct cpufreq_governor *gov = NULL;
884e18f1682SSrivatsa S. Bhat 	struct cpufreq_policy new_policy;
885e18f1682SSrivatsa S. Bhat 	int ret = 0;
886e18f1682SSrivatsa S. Bhat 
887d5b73cd8SViresh Kumar 	memcpy(&new_policy, policy, sizeof(*policy));
888a27a9ab7SJason Baron 
8896e2c89d1Sviresh kumar 	/* Update governor of new_policy to the governor used before hotplug */
8906e2c89d1Sviresh kumar 	gov = __find_governor(per_cpu(cpufreq_cpu_governor, policy->cpu));
8916e2c89d1Sviresh kumar 	if (gov)
8926e2c89d1Sviresh kumar 		pr_debug("Restoring governor %s for cpu %d\n",
8936e2c89d1Sviresh kumar 				policy->governor->name, policy->cpu);
8946e2c89d1Sviresh kumar 	else
8956e2c89d1Sviresh kumar 		gov = CPUFREQ_DEFAULT_GOVERNOR;
8966e2c89d1Sviresh kumar 
8976e2c89d1Sviresh kumar 	new_policy.governor = gov;
8986e2c89d1Sviresh kumar 
899a27a9ab7SJason Baron 	/* Use the default policy if its valid. */
900a27a9ab7SJason Baron 	if (cpufreq_driver->setpolicy)
9016e2c89d1Sviresh kumar 		cpufreq_parse_governor(gov->name, &new_policy.policy, NULL);
902ecf7e461SDave Jones 
903ecf7e461SDave Jones 	/* set default policy */
904037ce839SViresh Kumar 	ret = cpufreq_set_policy(policy, &new_policy);
905ecf7e461SDave Jones 	if (ret) {
9062d06d8c4SDominik Brodowski 		pr_debug("setting policy failed\n");
9071c3d85ddSRafael J. Wysocki 		if (cpufreq_driver->exit)
9081c3d85ddSRafael J. Wysocki 			cpufreq_driver->exit(policy);
909ecf7e461SDave Jones 	}
910909a694eSDave Jones }
911909a694eSDave Jones 
912fcf80582SViresh Kumar #ifdef CONFIG_HOTPLUG_CPU
913d8d3b471SViresh Kumar static int cpufreq_add_policy_cpu(struct cpufreq_policy *policy,
91442f921a6SViresh Kumar 				  unsigned int cpu, struct device *dev)
915fcf80582SViresh Kumar {
9169c0ebcf7SViresh Kumar 	int ret = 0;
917fcf80582SViresh Kumar 	unsigned long flags;
918fcf80582SViresh Kumar 
9199c0ebcf7SViresh Kumar 	if (has_target()) {
9203de9bdebSViresh Kumar 		ret = __cpufreq_governor(policy, CPUFREQ_GOV_STOP);
9213de9bdebSViresh Kumar 		if (ret) {
9223de9bdebSViresh Kumar 			pr_err("%s: Failed to stop governor\n", __func__);
9233de9bdebSViresh Kumar 			return ret;
9243de9bdebSViresh Kumar 		}
9253de9bdebSViresh Kumar 	}
926fcf80582SViresh Kumar 
927ad7722daSviresh kumar 	down_write(&policy->rwsem);
9282eaa3e2dSViresh Kumar 
9290d1857a1SNathan Zimmer 	write_lock_irqsave(&cpufreq_driver_lock, flags);
9302eaa3e2dSViresh Kumar 
931fcf80582SViresh Kumar 	cpumask_set_cpu(cpu, policy->cpus);
932fcf80582SViresh Kumar 	per_cpu(cpufreq_cpu_data, cpu) = policy;
9330d1857a1SNathan Zimmer 	write_unlock_irqrestore(&cpufreq_driver_lock, flags);
934fcf80582SViresh Kumar 
935ad7722daSviresh kumar 	up_write(&policy->rwsem);
9362eaa3e2dSViresh Kumar 
9379c0ebcf7SViresh Kumar 	if (has_target()) {
9383de9bdebSViresh Kumar 		if ((ret = __cpufreq_governor(policy, CPUFREQ_GOV_START)) ||
9393de9bdebSViresh Kumar 			(ret = __cpufreq_governor(policy, CPUFREQ_GOV_LIMITS))) {
9403de9bdebSViresh Kumar 			pr_err("%s: Failed to start governor\n", __func__);
9413de9bdebSViresh Kumar 			return ret;
9423de9bdebSViresh Kumar 		}
943820c6ca2SViresh Kumar 	}
944fcf80582SViresh Kumar 
94542f921a6SViresh Kumar 	return sysfs_create_link(&dev->kobj, &policy->kobj, "cpufreq");
946fcf80582SViresh Kumar }
947fcf80582SViresh Kumar #endif
9481da177e4SLinus Torvalds 
9498414809cSSrivatsa S. Bhat static struct cpufreq_policy *cpufreq_policy_restore(unsigned int cpu)
9508414809cSSrivatsa S. Bhat {
9518414809cSSrivatsa S. Bhat 	struct cpufreq_policy *policy;
9528414809cSSrivatsa S. Bhat 	unsigned long flags;
9538414809cSSrivatsa S. Bhat 
95444871c9cSLan Tianyu 	read_lock_irqsave(&cpufreq_driver_lock, flags);
9558414809cSSrivatsa S. Bhat 
9568414809cSSrivatsa S. Bhat 	policy = per_cpu(cpufreq_cpu_data_fallback, cpu);
9578414809cSSrivatsa S. Bhat 
95844871c9cSLan Tianyu 	read_unlock_irqrestore(&cpufreq_driver_lock, flags);
9598414809cSSrivatsa S. Bhat 
9606e2c89d1Sviresh kumar 	policy->governor = NULL;
9616e2c89d1Sviresh kumar 
9628414809cSSrivatsa S. Bhat 	return policy;
9638414809cSSrivatsa S. Bhat }
9648414809cSSrivatsa S. Bhat 
965e9698cc5SSrivatsa S. Bhat static struct cpufreq_policy *cpufreq_policy_alloc(void)
966e9698cc5SSrivatsa S. Bhat {
967e9698cc5SSrivatsa S. Bhat 	struct cpufreq_policy *policy;
968e9698cc5SSrivatsa S. Bhat 
969e9698cc5SSrivatsa S. Bhat 	policy = kzalloc(sizeof(*policy), GFP_KERNEL);
970e9698cc5SSrivatsa S. Bhat 	if (!policy)
971e9698cc5SSrivatsa S. Bhat 		return NULL;
972e9698cc5SSrivatsa S. Bhat 
973e9698cc5SSrivatsa S. Bhat 	if (!alloc_cpumask_var(&policy->cpus, GFP_KERNEL))
974e9698cc5SSrivatsa S. Bhat 		goto err_free_policy;
975e9698cc5SSrivatsa S. Bhat 
976e9698cc5SSrivatsa S. Bhat 	if (!zalloc_cpumask_var(&policy->related_cpus, GFP_KERNEL))
977e9698cc5SSrivatsa S. Bhat 		goto err_free_cpumask;
978e9698cc5SSrivatsa S. Bhat 
979c88a1f8bSLukasz Majewski 	INIT_LIST_HEAD(&policy->policy_list);
980ad7722daSviresh kumar 	init_rwsem(&policy->rwsem);
981ad7722daSviresh kumar 
982e9698cc5SSrivatsa S. Bhat 	return policy;
983e9698cc5SSrivatsa S. Bhat 
984e9698cc5SSrivatsa S. Bhat err_free_cpumask:
985e9698cc5SSrivatsa S. Bhat 	free_cpumask_var(policy->cpus);
986e9698cc5SSrivatsa S. Bhat err_free_policy:
987e9698cc5SSrivatsa S. Bhat 	kfree(policy);
988e9698cc5SSrivatsa S. Bhat 
989e9698cc5SSrivatsa S. Bhat 	return NULL;
990e9698cc5SSrivatsa S. Bhat }
991e9698cc5SSrivatsa S. Bhat 
99242f921a6SViresh Kumar static void cpufreq_policy_put_kobj(struct cpufreq_policy *policy)
99342f921a6SViresh Kumar {
99442f921a6SViresh Kumar 	struct kobject *kobj;
99542f921a6SViresh Kumar 	struct completion *cmp;
99642f921a6SViresh Kumar 
997fcd7af91SViresh Kumar 	blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
998fcd7af91SViresh Kumar 			CPUFREQ_REMOVE_POLICY, policy);
999fcd7af91SViresh Kumar 
100042f921a6SViresh Kumar 	down_read(&policy->rwsem);
100142f921a6SViresh Kumar 	kobj = &policy->kobj;
100242f921a6SViresh Kumar 	cmp = &policy->kobj_unregister;
100342f921a6SViresh Kumar 	up_read(&policy->rwsem);
100442f921a6SViresh Kumar 	kobject_put(kobj);
100542f921a6SViresh Kumar 
100642f921a6SViresh Kumar 	/*
100742f921a6SViresh Kumar 	 * We need to make sure that the underlying kobj is
100842f921a6SViresh Kumar 	 * actually not referenced anymore by anybody before we
100942f921a6SViresh Kumar 	 * proceed with unloading.
101042f921a6SViresh Kumar 	 */
101142f921a6SViresh Kumar 	pr_debug("waiting for dropping of refcount\n");
101242f921a6SViresh Kumar 	wait_for_completion(cmp);
101342f921a6SViresh Kumar 	pr_debug("wait complete\n");
101442f921a6SViresh Kumar }
101542f921a6SViresh Kumar 
1016e9698cc5SSrivatsa S. Bhat static void cpufreq_policy_free(struct cpufreq_policy *policy)
1017e9698cc5SSrivatsa S. Bhat {
1018e9698cc5SSrivatsa S. Bhat 	free_cpumask_var(policy->related_cpus);
1019e9698cc5SSrivatsa S. Bhat 	free_cpumask_var(policy->cpus);
1020e9698cc5SSrivatsa S. Bhat 	kfree(policy);
1021e9698cc5SSrivatsa S. Bhat }
1022e9698cc5SSrivatsa S. Bhat 
10230d66b91eSSrivatsa S. Bhat static void update_policy_cpu(struct cpufreq_policy *policy, unsigned int cpu)
10240d66b91eSSrivatsa S. Bhat {
102599ec899eSSrivatsa S. Bhat 	if (WARN_ON(cpu == policy->cpu))
1026cb38ed5cSSrivatsa S. Bhat 		return;
1027cb38ed5cSSrivatsa S. Bhat 
1028ad7722daSviresh kumar 	down_write(&policy->rwsem);
10298efd5765SViresh Kumar 
10300d66b91eSSrivatsa S. Bhat 	policy->last_cpu = policy->cpu;
10310d66b91eSSrivatsa S. Bhat 	policy->cpu = cpu;
10320d66b91eSSrivatsa S. Bhat 
1033ad7722daSviresh kumar 	up_write(&policy->rwsem);
10348efd5765SViresh Kumar 
10350d66b91eSSrivatsa S. Bhat 	cpufreq_frequency_table_update_policy_cpu(policy);
10360d66b91eSSrivatsa S. Bhat 	blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
10370d66b91eSSrivatsa S. Bhat 			CPUFREQ_UPDATE_POLICY_CPU, policy);
10380d66b91eSSrivatsa S. Bhat }
10390d66b91eSSrivatsa S. Bhat 
1040a82fab29SSrivatsa S. Bhat static int __cpufreq_add_dev(struct device *dev, struct subsys_interface *sif,
1041a82fab29SSrivatsa S. Bhat 			     bool frozen)
10421da177e4SLinus Torvalds {
1043fcf80582SViresh Kumar 	unsigned int j, cpu = dev->id;
104465922465SViresh Kumar 	int ret = -ENOMEM;
10451da177e4SLinus Torvalds 	struct cpufreq_policy *policy;
10461da177e4SLinus Torvalds 	unsigned long flags;
104790e41bacSPrarit Bhargava #ifdef CONFIG_HOTPLUG_CPU
10481b274294SViresh Kumar 	struct cpufreq_policy *tpolicy;
104990e41bacSPrarit Bhargava #endif
10501da177e4SLinus Torvalds 
1051c32b6b8eSAshok Raj 	if (cpu_is_offline(cpu))
1052c32b6b8eSAshok Raj 		return 0;
1053c32b6b8eSAshok Raj 
10542d06d8c4SDominik Brodowski 	pr_debug("adding CPU %u\n", cpu);
10551da177e4SLinus Torvalds 
10561da177e4SLinus Torvalds #ifdef CONFIG_SMP
10571da177e4SLinus Torvalds 	/* check whether a different CPU already registered this
10581da177e4SLinus Torvalds 	 * CPU because it is in the same boat. */
10591da177e4SLinus Torvalds 	policy = cpufreq_cpu_get(cpu);
10601da177e4SLinus Torvalds 	if (unlikely(policy)) {
10618ff69732SDave Jones 		cpufreq_cpu_put(policy);
10621da177e4SLinus Torvalds 		return 0;
10631da177e4SLinus Torvalds 	}
10645025d628SLi Zhong #endif
1065fcf80582SViresh Kumar 
10666eed9404SViresh Kumar 	if (!down_read_trylock(&cpufreq_rwsem))
10676eed9404SViresh Kumar 		return 0;
10686eed9404SViresh Kumar 
1069fcf80582SViresh Kumar #ifdef CONFIG_HOTPLUG_CPU
1070fcf80582SViresh Kumar 	/* Check if this cpu was hot-unplugged earlier and has siblings */
10710d1857a1SNathan Zimmer 	read_lock_irqsave(&cpufreq_driver_lock, flags);
10721b274294SViresh Kumar 	list_for_each_entry(tpolicy, &cpufreq_policy_list, policy_list) {
10731b274294SViresh Kumar 		if (cpumask_test_cpu(cpu, tpolicy->related_cpus)) {
10740d1857a1SNathan Zimmer 			read_unlock_irqrestore(&cpufreq_driver_lock, flags);
107542f921a6SViresh Kumar 			ret = cpufreq_add_policy_cpu(tpolicy, cpu, dev);
10766eed9404SViresh Kumar 			up_read(&cpufreq_rwsem);
10776eed9404SViresh Kumar 			return ret;
1078fcf80582SViresh Kumar 		}
10792eaa3e2dSViresh Kumar 	}
10800d1857a1SNathan Zimmer 	read_unlock_irqrestore(&cpufreq_driver_lock, flags);
1081fcf80582SViresh Kumar #endif
10821da177e4SLinus Torvalds 
108372368d12SRafael J. Wysocki 	/*
108472368d12SRafael J. Wysocki 	 * Restore the saved policy when doing light-weight init and fall back
108572368d12SRafael J. Wysocki 	 * to the full init if that fails.
108672368d12SRafael J. Wysocki 	 */
108772368d12SRafael J. Wysocki 	policy = frozen ? cpufreq_policy_restore(cpu) : NULL;
108872368d12SRafael J. Wysocki 	if (!policy) {
108972368d12SRafael J. Wysocki 		frozen = false;
1090e9698cc5SSrivatsa S. Bhat 		policy = cpufreq_policy_alloc();
1091059019a3SDave Jones 		if (!policy)
10921da177e4SLinus Torvalds 			goto nomem_out;
109372368d12SRafael J. Wysocki 	}
10940d66b91eSSrivatsa S. Bhat 
10950d66b91eSSrivatsa S. Bhat 	/*
10960d66b91eSSrivatsa S. Bhat 	 * In the resume path, since we restore a saved policy, the assignment
10970d66b91eSSrivatsa S. Bhat 	 * to policy->cpu is like an update of the existing policy, rather than
10980d66b91eSSrivatsa S. Bhat 	 * the creation of a brand new one. So we need to perform this update
10990d66b91eSSrivatsa S. Bhat 	 * by invoking update_policy_cpu().
11000d66b91eSSrivatsa S. Bhat 	 */
11010d66b91eSSrivatsa S. Bhat 	if (frozen && cpu != policy->cpu)
11020d66b91eSSrivatsa S. Bhat 		update_policy_cpu(policy, cpu);
11030d66b91eSSrivatsa S. Bhat 	else
11041da177e4SLinus Torvalds 		policy->cpu = cpu;
11050d66b91eSSrivatsa S. Bhat 
1106835481d9SRusty Russell 	cpumask_copy(policy->cpus, cpumask_of(cpu));
11071da177e4SLinus Torvalds 
11081da177e4SLinus Torvalds 	init_completion(&policy->kobj_unregister);
110965f27f38SDavid Howells 	INIT_WORK(&policy->update, handle_update);
11101da177e4SLinus Torvalds 
11111da177e4SLinus Torvalds 	/* call driver. From then on the cpufreq must be able
11121da177e4SLinus Torvalds 	 * to accept all calls to ->verify and ->setpolicy for this CPU
11131da177e4SLinus Torvalds 	 */
11141c3d85ddSRafael J. Wysocki 	ret = cpufreq_driver->init(policy);
11151da177e4SLinus Torvalds 	if (ret) {
11162d06d8c4SDominik Brodowski 		pr_debug("initialization failed\n");
11172eaa3e2dSViresh Kumar 		goto err_set_policy_cpu;
11181da177e4SLinus Torvalds 	}
1119643ae6e8SViresh Kumar 
11205a7e56a5SViresh Kumar 	/* related cpus should atleast have policy->cpus */
11215a7e56a5SViresh Kumar 	cpumask_or(policy->related_cpus, policy->related_cpus, policy->cpus);
11225a7e56a5SViresh Kumar 
11235a7e56a5SViresh Kumar 	/*
11245a7e56a5SViresh Kumar 	 * affected cpus must always be the one, which are online. We aren't
11255a7e56a5SViresh Kumar 	 * managing offline cpus here.
11265a7e56a5SViresh Kumar 	 */
11275a7e56a5SViresh Kumar 	cpumask_and(policy->cpus, policy->cpus, cpu_online_mask);
11285a7e56a5SViresh Kumar 
11295a7e56a5SViresh Kumar 	if (!frozen) {
11305a7e56a5SViresh Kumar 		policy->user_policy.min = policy->min;
11315a7e56a5SViresh Kumar 		policy->user_policy.max = policy->max;
11325a7e56a5SViresh Kumar 	}
11335a7e56a5SViresh Kumar 
11344e97b631SViresh Kumar 	down_write(&policy->rwsem);
1135652ed95dSViresh Kumar 	write_lock_irqsave(&cpufreq_driver_lock, flags);
1136652ed95dSViresh Kumar 	for_each_cpu(j, policy->cpus)
1137652ed95dSViresh Kumar 		per_cpu(cpufreq_cpu_data, j) = policy;
1138652ed95dSViresh Kumar 	write_unlock_irqrestore(&cpufreq_driver_lock, flags);
1139652ed95dSViresh Kumar 
1140da60ce9fSViresh Kumar 	if (cpufreq_driver->get) {
1141da60ce9fSViresh Kumar 		policy->cur = cpufreq_driver->get(policy->cpu);
1142da60ce9fSViresh Kumar 		if (!policy->cur) {
1143da60ce9fSViresh Kumar 			pr_err("%s: ->get() failed\n", __func__);
1144da60ce9fSViresh Kumar 			goto err_get_freq;
1145da60ce9fSViresh Kumar 		}
1146da60ce9fSViresh Kumar 	}
1147da60ce9fSViresh Kumar 
1148d3916691SViresh Kumar 	/*
1149d3916691SViresh Kumar 	 * Sometimes boot loaders set CPU frequency to a value outside of
1150d3916691SViresh Kumar 	 * frequency table present with cpufreq core. In such cases CPU might be
1151d3916691SViresh Kumar 	 * unstable if it has to run on that frequency for long duration of time
1152d3916691SViresh Kumar 	 * and so its better to set it to a frequency which is specified in
1153d3916691SViresh Kumar 	 * freq-table. This also makes cpufreq stats inconsistent as
1154d3916691SViresh Kumar 	 * cpufreq-stats would fail to register because current frequency of CPU
1155d3916691SViresh Kumar 	 * isn't found in freq-table.
1156d3916691SViresh Kumar 	 *
1157d3916691SViresh Kumar 	 * Because we don't want this change to effect boot process badly, we go
1158d3916691SViresh Kumar 	 * for the next freq which is >= policy->cur ('cur' must be set by now,
1159d3916691SViresh Kumar 	 * otherwise we will end up setting freq to lowest of the table as 'cur'
1160d3916691SViresh Kumar 	 * is initialized to zero).
1161d3916691SViresh Kumar 	 *
1162d3916691SViresh Kumar 	 * We are passing target-freq as "policy->cur - 1" otherwise
1163d3916691SViresh Kumar 	 * __cpufreq_driver_target() would simply fail, as policy->cur will be
1164d3916691SViresh Kumar 	 * equal to target-freq.
1165d3916691SViresh Kumar 	 */
1166d3916691SViresh Kumar 	if ((cpufreq_driver->flags & CPUFREQ_NEED_INITIAL_FREQ_CHECK)
1167d3916691SViresh Kumar 	    && has_target()) {
1168d3916691SViresh Kumar 		/* Are we running at unknown frequency ? */
1169d3916691SViresh Kumar 		ret = cpufreq_frequency_table_get_index(policy, policy->cur);
1170d3916691SViresh Kumar 		if (ret == -EINVAL) {
1171d3916691SViresh Kumar 			/* Warn user and fix it */
1172d3916691SViresh Kumar 			pr_warn("%s: CPU%d: Running at unlisted freq: %u KHz\n",
1173d3916691SViresh Kumar 				__func__, policy->cpu, policy->cur);
1174d3916691SViresh Kumar 			ret = __cpufreq_driver_target(policy, policy->cur - 1,
1175d3916691SViresh Kumar 				CPUFREQ_RELATION_L);
1176d3916691SViresh Kumar 
1177d3916691SViresh Kumar 			/*
1178d3916691SViresh Kumar 			 * Reaching here after boot in a few seconds may not
1179d3916691SViresh Kumar 			 * mean that system will remain stable at "unknown"
1180d3916691SViresh Kumar 			 * frequency for longer duration. Hence, a BUG_ON().
1181d3916691SViresh Kumar 			 */
1182d3916691SViresh Kumar 			BUG_ON(ret);
1183d3916691SViresh Kumar 			pr_warn("%s: CPU%d: Unlisted initial frequency changed to: %u KHz\n",
1184d3916691SViresh Kumar 				__func__, policy->cpu, policy->cur);
1185d3916691SViresh Kumar 		}
1186d3916691SViresh Kumar 	}
1187d3916691SViresh Kumar 
1188a1531acdSThomas Renninger 	blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
1189a1531acdSThomas Renninger 				     CPUFREQ_START, policy);
1190a1531acdSThomas Renninger 
1191a82fab29SSrivatsa S. Bhat 	if (!frozen) {
1192308b60e7SViresh Kumar 		ret = cpufreq_add_dev_interface(policy, dev);
119319d6f7ecSDave Jones 		if (ret)
11940142f9dcSAhmed S. Darwish 			goto err_out_unregister;
1195fcd7af91SViresh Kumar 		blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
1196fcd7af91SViresh Kumar 				CPUFREQ_CREATE_POLICY, policy);
11979515f4d6SViresh Kumar 	}
1198c88a1f8bSLukasz Majewski 
1199c88a1f8bSLukasz Majewski 	write_lock_irqsave(&cpufreq_driver_lock, flags);
1200c88a1f8bSLukasz Majewski 	list_add(&policy->policy_list, &cpufreq_policy_list);
1201c88a1f8bSLukasz Majewski 	write_unlock_irqrestore(&cpufreq_driver_lock, flags);
12028ff69732SDave Jones 
1203e18f1682SSrivatsa S. Bhat 	cpufreq_init_policy(policy);
1204e18f1682SSrivatsa S. Bhat 
120508fd8c1cSViresh Kumar 	if (!frozen) {
120608fd8c1cSViresh Kumar 		policy->user_policy.policy = policy->policy;
120708fd8c1cSViresh Kumar 		policy->user_policy.governor = policy->governor;
120808fd8c1cSViresh Kumar 	}
12094e97b631SViresh Kumar 	up_write(&policy->rwsem);
121008fd8c1cSViresh Kumar 
1211038c5b3eSGreg Kroah-Hartman 	kobject_uevent(&policy->kobj, KOBJ_ADD);
12126eed9404SViresh Kumar 	up_read(&cpufreq_rwsem);
12136eed9404SViresh Kumar 
12142d06d8c4SDominik Brodowski 	pr_debug("initialization complete\n");
12151da177e4SLinus Torvalds 
12161da177e4SLinus Torvalds 	return 0;
12171da177e4SLinus Torvalds 
12181da177e4SLinus Torvalds err_out_unregister:
1219652ed95dSViresh Kumar err_get_freq:
12200d1857a1SNathan Zimmer 	write_lock_irqsave(&cpufreq_driver_lock, flags);
1221474deff7SViresh Kumar 	for_each_cpu(j, policy->cpus)
12227a6aedfaSMike Travis 		per_cpu(cpufreq_cpu_data, j) = NULL;
12230d1857a1SNathan Zimmer 	write_unlock_irqrestore(&cpufreq_driver_lock, flags);
12241da177e4SLinus Torvalds 
1225da60ce9fSViresh Kumar 	if (cpufreq_driver->exit)
1226da60ce9fSViresh Kumar 		cpufreq_driver->exit(policy);
12272eaa3e2dSViresh Kumar err_set_policy_cpu:
122872368d12SRafael J. Wysocki 	if (frozen) {
122972368d12SRafael J. Wysocki 		/* Do not leave stale fallback data behind. */
123072368d12SRafael J. Wysocki 		per_cpu(cpufreq_cpu_data_fallback, cpu) = NULL;
123142f921a6SViresh Kumar 		cpufreq_policy_put_kobj(policy);
123272368d12SRafael J. Wysocki 	}
1233e9698cc5SSrivatsa S. Bhat 	cpufreq_policy_free(policy);
123442f921a6SViresh Kumar 
12351da177e4SLinus Torvalds nomem_out:
12366eed9404SViresh Kumar 	up_read(&cpufreq_rwsem);
12376eed9404SViresh Kumar 
12381da177e4SLinus Torvalds 	return ret;
12391da177e4SLinus Torvalds }
12401da177e4SLinus Torvalds 
1241a82fab29SSrivatsa S. Bhat /**
1242a82fab29SSrivatsa S. Bhat  * cpufreq_add_dev - add a CPU device
1243a82fab29SSrivatsa S. Bhat  *
1244a82fab29SSrivatsa S. Bhat  * Adds the cpufreq interface for a CPU device.
1245a82fab29SSrivatsa S. Bhat  *
1246a82fab29SSrivatsa S. Bhat  * The Oracle says: try running cpufreq registration/unregistration concurrently
1247a82fab29SSrivatsa S. Bhat  * with with cpu hotplugging and all hell will break loose. Tried to clean this
1248a82fab29SSrivatsa S. Bhat  * mess up, but more thorough testing is needed. - Mathieu
1249a82fab29SSrivatsa S. Bhat  */
1250a82fab29SSrivatsa S. Bhat static int cpufreq_add_dev(struct device *dev, struct subsys_interface *sif)
1251a82fab29SSrivatsa S. Bhat {
1252a82fab29SSrivatsa S. Bhat 	return __cpufreq_add_dev(dev, sif, false);
1253a82fab29SSrivatsa S. Bhat }
1254a82fab29SSrivatsa S. Bhat 
12553a3e9e06SViresh Kumar static int cpufreq_nominate_new_policy_cpu(struct cpufreq_policy *policy,
125642f921a6SViresh Kumar 					   unsigned int old_cpu)
1257f9ba680dSSrivatsa S. Bhat {
1258f9ba680dSSrivatsa S. Bhat 	struct device *cpu_dev;
1259f9ba680dSSrivatsa S. Bhat 	int ret;
1260f9ba680dSSrivatsa S. Bhat 
1261f9ba680dSSrivatsa S. Bhat 	/* first sibling now owns the new sysfs dir */
12629c8f1ee4SViresh Kumar 	cpu_dev = get_cpu_device(cpumask_any_but(policy->cpus, old_cpu));
1263a82fab29SSrivatsa S. Bhat 
1264f9ba680dSSrivatsa S. Bhat 	sysfs_remove_link(&cpu_dev->kobj, "cpufreq");
12653a3e9e06SViresh Kumar 	ret = kobject_move(&policy->kobj, &cpu_dev->kobj);
1266f9ba680dSSrivatsa S. Bhat 	if (ret) {
1267f9ba680dSSrivatsa S. Bhat 		pr_err("%s: Failed to move kobj: %d", __func__, ret);
1268f9ba680dSSrivatsa S. Bhat 
1269ad7722daSviresh kumar 		down_write(&policy->rwsem);
12703a3e9e06SViresh Kumar 		cpumask_set_cpu(old_cpu, policy->cpus);
1271ad7722daSviresh kumar 		up_write(&policy->rwsem);
1272f9ba680dSSrivatsa S. Bhat 
12733a3e9e06SViresh Kumar 		ret = sysfs_create_link(&cpu_dev->kobj, &policy->kobj,
1274f9ba680dSSrivatsa S. Bhat 					"cpufreq");
1275f9ba680dSSrivatsa S. Bhat 
1276f9ba680dSSrivatsa S. Bhat 		return -EINVAL;
1277f9ba680dSSrivatsa S. Bhat 	}
1278f9ba680dSSrivatsa S. Bhat 
1279f9ba680dSSrivatsa S. Bhat 	return cpu_dev->id;
1280f9ba680dSSrivatsa S. Bhat }
1281f9ba680dSSrivatsa S. Bhat 
1282cedb70afSSrivatsa S. Bhat static int __cpufreq_remove_dev_prepare(struct device *dev,
1283cedb70afSSrivatsa S. Bhat 					struct subsys_interface *sif,
1284cedb70afSSrivatsa S. Bhat 					bool frozen)
12851da177e4SLinus Torvalds {
1286f9ba680dSSrivatsa S. Bhat 	unsigned int cpu = dev->id, cpus;
12873de9bdebSViresh Kumar 	int new_cpu, ret;
12881da177e4SLinus Torvalds 	unsigned long flags;
12893a3e9e06SViresh Kumar 	struct cpufreq_policy *policy;
12901da177e4SLinus Torvalds 
1291b8eed8afSViresh Kumar 	pr_debug("%s: unregistering CPU %u\n", __func__, cpu);
12921da177e4SLinus Torvalds 
12930d1857a1SNathan Zimmer 	write_lock_irqsave(&cpufreq_driver_lock, flags);
12941da177e4SLinus Torvalds 
12953a3e9e06SViresh Kumar 	policy = per_cpu(cpufreq_cpu_data, cpu);
12961da177e4SLinus Torvalds 
12978414809cSSrivatsa S. Bhat 	/* Save the policy somewhere when doing a light-weight tear-down */
12988414809cSSrivatsa S. Bhat 	if (frozen)
12993a3e9e06SViresh Kumar 		per_cpu(cpufreq_cpu_data_fallback, cpu) = policy;
13008414809cSSrivatsa S. Bhat 
13010d1857a1SNathan Zimmer 	write_unlock_irqrestore(&cpufreq_driver_lock, flags);
13021da177e4SLinus Torvalds 
13033a3e9e06SViresh Kumar 	if (!policy) {
1304b8eed8afSViresh Kumar 		pr_debug("%s: No cpu_data found\n", __func__);
13051da177e4SLinus Torvalds 		return -EINVAL;
13061da177e4SLinus Torvalds 	}
13071da177e4SLinus Torvalds 
13089c0ebcf7SViresh Kumar 	if (has_target()) {
13093de9bdebSViresh Kumar 		ret = __cpufreq_governor(policy, CPUFREQ_GOV_STOP);
13103de9bdebSViresh Kumar 		if (ret) {
13113de9bdebSViresh Kumar 			pr_err("%s: Failed to stop governor\n", __func__);
13123de9bdebSViresh Kumar 			return ret;
13133de9bdebSViresh Kumar 		}
13143de9bdebSViresh Kumar 	}
13155a01f2e8SVenkatesh Pallipadi 
13161c3d85ddSRafael J. Wysocki 	if (!cpufreq_driver->setpolicy)
1317fa69e33fSDirk Brandewie 		strncpy(per_cpu(cpufreq_cpu_governor, cpu),
13183a3e9e06SViresh Kumar 			policy->governor->name, CPUFREQ_NAME_LEN);
13191da177e4SLinus Torvalds 
1320ad7722daSviresh kumar 	down_read(&policy->rwsem);
13213a3e9e06SViresh Kumar 	cpus = cpumask_weight(policy->cpus);
1322ad7722daSviresh kumar 	up_read(&policy->rwsem);
13231da177e4SLinus Torvalds 
132461173f25SSrivatsa S. Bhat 	if (cpu != policy->cpu) {
132573bf0fc2SViresh Kumar 		sysfs_remove_link(&dev->kobj, "cpufreq");
132673bf0fc2SViresh Kumar 	} else if (cpus > 1) {
132742f921a6SViresh Kumar 		new_cpu = cpufreq_nominate_new_policy_cpu(policy, cpu);
1328f9ba680dSSrivatsa S. Bhat 		if (new_cpu >= 0) {
13293a3e9e06SViresh Kumar 			update_policy_cpu(policy, new_cpu);
1330a82fab29SSrivatsa S. Bhat 
1331a82fab29SSrivatsa S. Bhat 			if (!frozen) {
133275949c9aSViresh Kumar 				pr_debug("%s: policy Kobject moved to cpu: %d from: %d\n",
133375949c9aSViresh Kumar 						__func__, new_cpu, cpu);
13341da177e4SLinus Torvalds 			}
13351da177e4SLinus Torvalds 		}
1336a82fab29SSrivatsa S. Bhat 	}
1337b8eed8afSViresh Kumar 
1338cedb70afSSrivatsa S. Bhat 	return 0;
1339cedb70afSSrivatsa S. Bhat }
1340cedb70afSSrivatsa S. Bhat 
1341cedb70afSSrivatsa S. Bhat static int __cpufreq_remove_dev_finish(struct device *dev,
1342cedb70afSSrivatsa S. Bhat 				       struct subsys_interface *sif,
1343cedb70afSSrivatsa S. Bhat 				       bool frozen)
1344cedb70afSSrivatsa S. Bhat {
1345cedb70afSSrivatsa S. Bhat 	unsigned int cpu = dev->id, cpus;
1346cedb70afSSrivatsa S. Bhat 	int ret;
1347cedb70afSSrivatsa S. Bhat 	unsigned long flags;
1348cedb70afSSrivatsa S. Bhat 	struct cpufreq_policy *policy;
1349cedb70afSSrivatsa S. Bhat 
1350cedb70afSSrivatsa S. Bhat 	read_lock_irqsave(&cpufreq_driver_lock, flags);
1351cedb70afSSrivatsa S. Bhat 	policy = per_cpu(cpufreq_cpu_data, cpu);
1352cedb70afSSrivatsa S. Bhat 	read_unlock_irqrestore(&cpufreq_driver_lock, flags);
1353cedb70afSSrivatsa S. Bhat 
1354cedb70afSSrivatsa S. Bhat 	if (!policy) {
1355cedb70afSSrivatsa S. Bhat 		pr_debug("%s: No cpu_data found\n", __func__);
1356cedb70afSSrivatsa S. Bhat 		return -EINVAL;
1357cedb70afSSrivatsa S. Bhat 	}
1358cedb70afSSrivatsa S. Bhat 
1359ad7722daSviresh kumar 	down_write(&policy->rwsem);
1360cedb70afSSrivatsa S. Bhat 	cpus = cpumask_weight(policy->cpus);
13619c8f1ee4SViresh Kumar 
13629c8f1ee4SViresh Kumar 	if (cpus > 1)
13639c8f1ee4SViresh Kumar 		cpumask_clear_cpu(cpu, policy->cpus);
1364ad7722daSviresh kumar 	up_write(&policy->rwsem);
1365cedb70afSSrivatsa S. Bhat 
1366b8eed8afSViresh Kumar 	/* If cpu is last user of policy, free policy */
1367b8eed8afSViresh Kumar 	if (cpus == 1) {
13689c0ebcf7SViresh Kumar 		if (has_target()) {
13693de9bdebSViresh Kumar 			ret = __cpufreq_governor(policy,
13703de9bdebSViresh Kumar 					CPUFREQ_GOV_POLICY_EXIT);
13713de9bdebSViresh Kumar 			if (ret) {
13723de9bdebSViresh Kumar 				pr_err("%s: Failed to exit governor\n",
13733de9bdebSViresh Kumar 						__func__);
13743de9bdebSViresh Kumar 				return ret;
13753de9bdebSViresh Kumar 			}
13763de9bdebSViresh Kumar 		}
13772a998599SRafael J. Wysocki 
137842f921a6SViresh Kumar 		if (!frozen)
137942f921a6SViresh Kumar 			cpufreq_policy_put_kobj(policy);
13801da177e4SLinus Torvalds 
13818414809cSSrivatsa S. Bhat 		/*
13828414809cSSrivatsa S. Bhat 		 * Perform the ->exit() even during light-weight tear-down,
13838414809cSSrivatsa S. Bhat 		 * since this is a core component, and is essential for the
13848414809cSSrivatsa S. Bhat 		 * subsequent light-weight ->init() to succeed.
13858414809cSSrivatsa S. Bhat 		 */
13861c3d85ddSRafael J. Wysocki 		if (cpufreq_driver->exit)
13873a3e9e06SViresh Kumar 			cpufreq_driver->exit(policy);
138827ecddc2SJacob Shin 
13899515f4d6SViresh Kumar 		/* Remove policy from list of active policies */
13909515f4d6SViresh Kumar 		write_lock_irqsave(&cpufreq_driver_lock, flags);
13919515f4d6SViresh Kumar 		list_del(&policy->policy_list);
13929515f4d6SViresh Kumar 		write_unlock_irqrestore(&cpufreq_driver_lock, flags);
13939515f4d6SViresh Kumar 
13948414809cSSrivatsa S. Bhat 		if (!frozen)
13953a3e9e06SViresh Kumar 			cpufreq_policy_free(policy);
13962a998599SRafael J. Wysocki 	} else {
13979c0ebcf7SViresh Kumar 		if (has_target()) {
13983de9bdebSViresh Kumar 			if ((ret = __cpufreq_governor(policy, CPUFREQ_GOV_START)) ||
13993de9bdebSViresh Kumar 					(ret = __cpufreq_governor(policy, CPUFREQ_GOV_LIMITS))) {
14003de9bdebSViresh Kumar 				pr_err("%s: Failed to start governor\n",
14013de9bdebSViresh Kumar 						__func__);
14023de9bdebSViresh Kumar 				return ret;
14033de9bdebSViresh Kumar 			}
1404b8eed8afSViresh Kumar 		}
14052a998599SRafael J. Wysocki 	}
14061da177e4SLinus Torvalds 
1407474deff7SViresh Kumar 	per_cpu(cpufreq_cpu_data, cpu) = NULL;
14081da177e4SLinus Torvalds 	return 0;
14091da177e4SLinus Torvalds }
14101da177e4SLinus Torvalds 
1411cedb70afSSrivatsa S. Bhat /**
141227a862e9SViresh Kumar  * cpufreq_remove_dev - remove a CPU device
1413cedb70afSSrivatsa S. Bhat  *
1414cedb70afSSrivatsa S. Bhat  * Removes the cpufreq interface for a CPU device.
1415cedb70afSSrivatsa S. Bhat  */
14168a25a2fdSKay Sievers static int cpufreq_remove_dev(struct device *dev, struct subsys_interface *sif)
14175a01f2e8SVenkatesh Pallipadi {
14188a25a2fdSKay Sievers 	unsigned int cpu = dev->id;
141927a862e9SViresh Kumar 	int ret;
1420ec28297aSVenki Pallipadi 
1421ec28297aSVenki Pallipadi 	if (cpu_is_offline(cpu))
1422ec28297aSVenki Pallipadi 		return 0;
1423ec28297aSVenki Pallipadi 
142427a862e9SViresh Kumar 	ret = __cpufreq_remove_dev_prepare(dev, sif, false);
142527a862e9SViresh Kumar 
142627a862e9SViresh Kumar 	if (!ret)
142727a862e9SViresh Kumar 		ret = __cpufreq_remove_dev_finish(dev, sif, false);
142827a862e9SViresh Kumar 
142927a862e9SViresh Kumar 	return ret;
14305a01f2e8SVenkatesh Pallipadi }
14315a01f2e8SVenkatesh Pallipadi 
143265f27f38SDavid Howells static void handle_update(struct work_struct *work)
14331da177e4SLinus Torvalds {
143465f27f38SDavid Howells 	struct cpufreq_policy *policy =
143565f27f38SDavid Howells 		container_of(work, struct cpufreq_policy, update);
143665f27f38SDavid Howells 	unsigned int cpu = policy->cpu;
14372d06d8c4SDominik Brodowski 	pr_debug("handle_update for cpu %u called\n", cpu);
14381da177e4SLinus Torvalds 	cpufreq_update_policy(cpu);
14391da177e4SLinus Torvalds }
14401da177e4SLinus Torvalds 
14411da177e4SLinus Torvalds /**
1442bb176f7dSViresh Kumar  *	cpufreq_out_of_sync - If actual and saved CPU frequency differs, we're
1443bb176f7dSViresh Kumar  *	in deep trouble.
14441da177e4SLinus Torvalds  *	@cpu: cpu number
14451da177e4SLinus Torvalds  *	@old_freq: CPU frequency the kernel thinks the CPU runs at
14461da177e4SLinus Torvalds  *	@new_freq: CPU frequency the CPU actually runs at
14471da177e4SLinus Torvalds  *
144829464f28SDave Jones  *	We adjust to current frequency first, and need to clean up later.
144929464f28SDave Jones  *	So either call to cpufreq_update_policy() or schedule handle_update()).
14501da177e4SLinus Torvalds  */
1451e08f5f5bSGautham R Shenoy static void cpufreq_out_of_sync(unsigned int cpu, unsigned int old_freq,
1452e08f5f5bSGautham R Shenoy 				unsigned int new_freq)
14531da177e4SLinus Torvalds {
1454b43a7ffbSViresh Kumar 	struct cpufreq_policy *policy;
14551da177e4SLinus Torvalds 	struct cpufreq_freqs freqs;
1456b43a7ffbSViresh Kumar 	unsigned long flags;
1457b43a7ffbSViresh Kumar 
14582d06d8c4SDominik Brodowski 	pr_debug("Warning: CPU frequency out of sync: cpufreq and timing "
14591da177e4SLinus Torvalds 	       "core thinks of %u, is %u kHz.\n", old_freq, new_freq);
14601da177e4SLinus Torvalds 
14611da177e4SLinus Torvalds 	freqs.old = old_freq;
14621da177e4SLinus Torvalds 	freqs.new = new_freq;
1463b43a7ffbSViresh Kumar 
1464b43a7ffbSViresh Kumar 	read_lock_irqsave(&cpufreq_driver_lock, flags);
1465b43a7ffbSViresh Kumar 	policy = per_cpu(cpufreq_cpu_data, cpu);
1466b43a7ffbSViresh Kumar 	read_unlock_irqrestore(&cpufreq_driver_lock, flags);
1467b43a7ffbSViresh Kumar 
1468b43a7ffbSViresh Kumar 	cpufreq_notify_transition(policy, &freqs, CPUFREQ_PRECHANGE);
1469b43a7ffbSViresh Kumar 	cpufreq_notify_transition(policy, &freqs, CPUFREQ_POSTCHANGE);
14701da177e4SLinus Torvalds }
14711da177e4SLinus Torvalds 
14721da177e4SLinus Torvalds /**
14734ab70df4SDhaval Giani  * cpufreq_quick_get - get the CPU frequency (in kHz) from policy->cur
147495235ca2SVenkatesh Pallipadi  * @cpu: CPU number
147595235ca2SVenkatesh Pallipadi  *
147695235ca2SVenkatesh Pallipadi  * This is the last known freq, without actually getting it from the driver.
147795235ca2SVenkatesh Pallipadi  * Return value will be same as what is shown in scaling_cur_freq in sysfs.
147895235ca2SVenkatesh Pallipadi  */
147995235ca2SVenkatesh Pallipadi unsigned int cpufreq_quick_get(unsigned int cpu)
148095235ca2SVenkatesh Pallipadi {
14819e21ba8bSDirk Brandewie 	struct cpufreq_policy *policy;
1482e08f5f5bSGautham R Shenoy 	unsigned int ret_freq = 0;
148395235ca2SVenkatesh Pallipadi 
14841c3d85ddSRafael J. Wysocki 	if (cpufreq_driver && cpufreq_driver->setpolicy && cpufreq_driver->get)
14851c3d85ddSRafael J. Wysocki 		return cpufreq_driver->get(cpu);
14869e21ba8bSDirk Brandewie 
14879e21ba8bSDirk Brandewie 	policy = cpufreq_cpu_get(cpu);
148895235ca2SVenkatesh Pallipadi 	if (policy) {
1489e08f5f5bSGautham R Shenoy 		ret_freq = policy->cur;
149095235ca2SVenkatesh Pallipadi 		cpufreq_cpu_put(policy);
149195235ca2SVenkatesh Pallipadi 	}
149295235ca2SVenkatesh Pallipadi 
14934d34a67dSDave Jones 	return ret_freq;
149495235ca2SVenkatesh Pallipadi }
149595235ca2SVenkatesh Pallipadi EXPORT_SYMBOL(cpufreq_quick_get);
149695235ca2SVenkatesh Pallipadi 
14973d737108SJesse Barnes /**
14983d737108SJesse Barnes  * cpufreq_quick_get_max - get the max reported CPU frequency for this CPU
14993d737108SJesse Barnes  * @cpu: CPU number
15003d737108SJesse Barnes  *
15013d737108SJesse Barnes  * Just return the max possible frequency for a given CPU.
15023d737108SJesse Barnes  */
15033d737108SJesse Barnes unsigned int cpufreq_quick_get_max(unsigned int cpu)
15043d737108SJesse Barnes {
15053d737108SJesse Barnes 	struct cpufreq_policy *policy = cpufreq_cpu_get(cpu);
15063d737108SJesse Barnes 	unsigned int ret_freq = 0;
15073d737108SJesse Barnes 
15083d737108SJesse Barnes 	if (policy) {
15093d737108SJesse Barnes 		ret_freq = policy->max;
15103d737108SJesse Barnes 		cpufreq_cpu_put(policy);
15113d737108SJesse Barnes 	}
15123d737108SJesse Barnes 
15133d737108SJesse Barnes 	return ret_freq;
15143d737108SJesse Barnes }
15153d737108SJesse Barnes EXPORT_SYMBOL(cpufreq_quick_get_max);
15163d737108SJesse Barnes 
15175a01f2e8SVenkatesh Pallipadi static unsigned int __cpufreq_get(unsigned int cpu)
15181da177e4SLinus Torvalds {
15197a6aedfaSMike Travis 	struct cpufreq_policy *policy = per_cpu(cpufreq_cpu_data, cpu);
1520e08f5f5bSGautham R Shenoy 	unsigned int ret_freq = 0;
15211da177e4SLinus Torvalds 
15221c3d85ddSRafael J. Wysocki 	if (!cpufreq_driver->get)
15234d34a67dSDave Jones 		return ret_freq;
15241da177e4SLinus Torvalds 
15251c3d85ddSRafael J. Wysocki 	ret_freq = cpufreq_driver->get(cpu);
15261da177e4SLinus Torvalds 
1527e08f5f5bSGautham R Shenoy 	if (ret_freq && policy->cur &&
15281c3d85ddSRafael J. Wysocki 		!(cpufreq_driver->flags & CPUFREQ_CONST_LOOPS)) {
1529e08f5f5bSGautham R Shenoy 		/* verify no discrepancy between actual and
1530e08f5f5bSGautham R Shenoy 					saved value exists */
1531e08f5f5bSGautham R Shenoy 		if (unlikely(ret_freq != policy->cur)) {
1532e08f5f5bSGautham R Shenoy 			cpufreq_out_of_sync(cpu, policy->cur, ret_freq);
15331da177e4SLinus Torvalds 			schedule_work(&policy->update);
15341da177e4SLinus Torvalds 		}
15351da177e4SLinus Torvalds 	}
15361da177e4SLinus Torvalds 
15374d34a67dSDave Jones 	return ret_freq;
15385a01f2e8SVenkatesh Pallipadi }
15391da177e4SLinus Torvalds 
15405a01f2e8SVenkatesh Pallipadi /**
15415a01f2e8SVenkatesh Pallipadi  * cpufreq_get - get the current CPU frequency (in kHz)
15425a01f2e8SVenkatesh Pallipadi  * @cpu: CPU number
15435a01f2e8SVenkatesh Pallipadi  *
15445a01f2e8SVenkatesh Pallipadi  * Get the CPU current (static) CPU frequency
15455a01f2e8SVenkatesh Pallipadi  */
15465a01f2e8SVenkatesh Pallipadi unsigned int cpufreq_get(unsigned int cpu)
15475a01f2e8SVenkatesh Pallipadi {
1548999976e0SAaron Plattner 	struct cpufreq_policy *policy = cpufreq_cpu_get(cpu);
15495a01f2e8SVenkatesh Pallipadi 	unsigned int ret_freq = 0;
15505a01f2e8SVenkatesh Pallipadi 
1551999976e0SAaron Plattner 	if (policy) {
1552ad7722daSviresh kumar 		down_read(&policy->rwsem);
15535a01f2e8SVenkatesh Pallipadi 		ret_freq = __cpufreq_get(cpu);
1554ad7722daSviresh kumar 		up_read(&policy->rwsem);
1555999976e0SAaron Plattner 
1556999976e0SAaron Plattner 		cpufreq_cpu_put(policy);
1557999976e0SAaron Plattner 	}
15586eed9404SViresh Kumar 
15594d34a67dSDave Jones 	return ret_freq;
15601da177e4SLinus Torvalds }
15611da177e4SLinus Torvalds EXPORT_SYMBOL(cpufreq_get);
15621da177e4SLinus Torvalds 
15638a25a2fdSKay Sievers static struct subsys_interface cpufreq_interface = {
15648a25a2fdSKay Sievers 	.name		= "cpufreq",
15658a25a2fdSKay Sievers 	.subsys		= &cpu_subsys,
15668a25a2fdSKay Sievers 	.add_dev	= cpufreq_add_dev,
15678a25a2fdSKay Sievers 	.remove_dev	= cpufreq_remove_dev,
1568e00e56dfSRafael J. Wysocki };
1569e00e56dfSRafael J. Wysocki 
15701da177e4SLinus Torvalds /**
1571*2f0aea93SViresh Kumar  * cpufreq_suspend() - Suspend CPUFreq governors
1572e00e56dfSRafael J. Wysocki  *
1573*2f0aea93SViresh Kumar  * Called during system wide Suspend/Hibernate cycles for suspending governors
1574*2f0aea93SViresh Kumar  * as some platforms can't change frequency after this point in suspend cycle.
1575*2f0aea93SViresh Kumar  * Because some of the devices (like: i2c, regulators, etc) they use for
1576*2f0aea93SViresh Kumar  * changing frequency are suspended quickly after this point.
157742d4dc3fSBenjamin Herrenschmidt  */
1578*2f0aea93SViresh Kumar void cpufreq_suspend(void)
157942d4dc3fSBenjamin Herrenschmidt {
15803a3e9e06SViresh Kumar 	struct cpufreq_policy *policy;
158142d4dc3fSBenjamin Herrenschmidt 
1582*2f0aea93SViresh Kumar 	if (!cpufreq_driver)
1583*2f0aea93SViresh Kumar 		return;
158442d4dc3fSBenjamin Herrenschmidt 
1585*2f0aea93SViresh Kumar 	if (!has_target())
1586*2f0aea93SViresh Kumar 		return;
158742d4dc3fSBenjamin Herrenschmidt 
1588*2f0aea93SViresh Kumar 	pr_debug("%s: Suspending Governors\n", __func__);
1589*2f0aea93SViresh Kumar 
1590*2f0aea93SViresh Kumar 	list_for_each_entry(policy, &cpufreq_policy_list, policy_list) {
1591*2f0aea93SViresh Kumar 		if (__cpufreq_governor(policy, CPUFREQ_GOV_STOP))
1592*2f0aea93SViresh Kumar 			pr_err("%s: Failed to stop governor for policy: %p\n",
1593*2f0aea93SViresh Kumar 				__func__, policy);
1594*2f0aea93SViresh Kumar 		else if (cpufreq_driver->suspend
1595*2f0aea93SViresh Kumar 		    && cpufreq_driver->suspend(policy))
1596*2f0aea93SViresh Kumar 			pr_err("%s: Failed to suspend driver: %p\n", __func__,
1597*2f0aea93SViresh Kumar 				policy);
159842d4dc3fSBenjamin Herrenschmidt 	}
159942d4dc3fSBenjamin Herrenschmidt 
1600*2f0aea93SViresh Kumar 	cpufreq_suspended = true;
160142d4dc3fSBenjamin Herrenschmidt }
160242d4dc3fSBenjamin Herrenschmidt 
160342d4dc3fSBenjamin Herrenschmidt /**
1604*2f0aea93SViresh Kumar  * cpufreq_resume() - Resume CPUFreq governors
16051da177e4SLinus Torvalds  *
1606*2f0aea93SViresh Kumar  * Called during system wide Suspend/Hibernate cycle for resuming governors that
1607*2f0aea93SViresh Kumar  * are suspended with cpufreq_suspend().
16081da177e4SLinus Torvalds  */
1609*2f0aea93SViresh Kumar void cpufreq_resume(void)
16101da177e4SLinus Torvalds {
16113a3e9e06SViresh Kumar 	struct cpufreq_policy *policy;
16121da177e4SLinus Torvalds 
1613*2f0aea93SViresh Kumar 	if (!cpufreq_driver)
1614e00e56dfSRafael J. Wysocki 		return;
16151da177e4SLinus Torvalds 
1616*2f0aea93SViresh Kumar 	if (!has_target())
1617*2f0aea93SViresh Kumar 		return;
16181da177e4SLinus Torvalds 
1619*2f0aea93SViresh Kumar 	pr_debug("%s: Resuming Governors\n", __func__);
1620*2f0aea93SViresh Kumar 
1621*2f0aea93SViresh Kumar 	cpufreq_suspended = false;
1622*2f0aea93SViresh Kumar 
1623*2f0aea93SViresh Kumar 	list_for_each_entry(policy, &cpufreq_policy_list, policy_list) {
1624*2f0aea93SViresh Kumar 		if (__cpufreq_governor(policy, CPUFREQ_GOV_START)
1625*2f0aea93SViresh Kumar 		    || __cpufreq_governor(policy, CPUFREQ_GOV_LIMITS))
1626*2f0aea93SViresh Kumar 			pr_err("%s: Failed to start governor for policy: %p\n",
1627*2f0aea93SViresh Kumar 				__func__, policy);
1628*2f0aea93SViresh Kumar 		else if (cpufreq_driver->resume
1629*2f0aea93SViresh Kumar 		    && cpufreq_driver->resume(policy))
1630*2f0aea93SViresh Kumar 			pr_err("%s: Failed to resume driver: %p\n", __func__,
1631*2f0aea93SViresh Kumar 				policy);
1632*2f0aea93SViresh Kumar 
1633*2f0aea93SViresh Kumar 		/*
1634*2f0aea93SViresh Kumar 		 * schedule call cpufreq_update_policy() for boot CPU, i.e. last
1635*2f0aea93SViresh Kumar 		 * policy in list. It will verify that the current freq is in
1636*2f0aea93SViresh Kumar 		 * sync with what we believe it to be.
1637*2f0aea93SViresh Kumar 		 */
1638*2f0aea93SViresh Kumar 		if (list_is_last(&policy->policy_list, &cpufreq_policy_list))
16393a3e9e06SViresh Kumar 			schedule_work(&policy->update);
16401da177e4SLinus Torvalds 	}
1641*2f0aea93SViresh Kumar }
16421da177e4SLinus Torvalds 
16439d95046eSBorislav Petkov /**
16449d95046eSBorislav Petkov  *	cpufreq_get_current_driver - return current driver's name
16459d95046eSBorislav Petkov  *
16469d95046eSBorislav Petkov  *	Return the name string of the currently loaded cpufreq driver
16479d95046eSBorislav Petkov  *	or NULL, if none.
16489d95046eSBorislav Petkov  */
16499d95046eSBorislav Petkov const char *cpufreq_get_current_driver(void)
16509d95046eSBorislav Petkov {
16511c3d85ddSRafael J. Wysocki 	if (cpufreq_driver)
16521c3d85ddSRafael J. Wysocki 		return cpufreq_driver->name;
16531c3d85ddSRafael J. Wysocki 
16541c3d85ddSRafael J. Wysocki 	return NULL;
16559d95046eSBorislav Petkov }
16569d95046eSBorislav Petkov EXPORT_SYMBOL_GPL(cpufreq_get_current_driver);
16571da177e4SLinus Torvalds 
16581da177e4SLinus Torvalds /*********************************************************************
16591da177e4SLinus Torvalds  *                     NOTIFIER LISTS INTERFACE                      *
16601da177e4SLinus Torvalds  *********************************************************************/
16611da177e4SLinus Torvalds 
16621da177e4SLinus Torvalds /**
16631da177e4SLinus Torvalds  *	cpufreq_register_notifier - register a driver with cpufreq
16641da177e4SLinus Torvalds  *	@nb: notifier function to register
16651da177e4SLinus Torvalds  *      @list: CPUFREQ_TRANSITION_NOTIFIER or CPUFREQ_POLICY_NOTIFIER
16661da177e4SLinus Torvalds  *
16671da177e4SLinus Torvalds  *	Add a driver to one of two lists: either a list of drivers that
16681da177e4SLinus Torvalds  *      are notified about clock rate changes (once before and once after
16691da177e4SLinus Torvalds  *      the transition), or a list of drivers that are notified about
16701da177e4SLinus Torvalds  *      changes in cpufreq policy.
16711da177e4SLinus Torvalds  *
16721da177e4SLinus Torvalds  *	This function may sleep, and has the same return conditions as
1673e041c683SAlan Stern  *	blocking_notifier_chain_register.
16741da177e4SLinus Torvalds  */
16751da177e4SLinus Torvalds int cpufreq_register_notifier(struct notifier_block *nb, unsigned int list)
16761da177e4SLinus Torvalds {
16771da177e4SLinus Torvalds 	int ret;
16781da177e4SLinus Torvalds 
1679d5aaffa9SDirk Brandewie 	if (cpufreq_disabled())
1680d5aaffa9SDirk Brandewie 		return -EINVAL;
1681d5aaffa9SDirk Brandewie 
168274212ca4SCesar Eduardo Barros 	WARN_ON(!init_cpufreq_transition_notifier_list_called);
168374212ca4SCesar Eduardo Barros 
16841da177e4SLinus Torvalds 	switch (list) {
16851da177e4SLinus Torvalds 	case CPUFREQ_TRANSITION_NOTIFIER:
1686b4dfdbb3SAlan Stern 		ret = srcu_notifier_chain_register(
1687e041c683SAlan Stern 				&cpufreq_transition_notifier_list, nb);
16881da177e4SLinus Torvalds 		break;
16891da177e4SLinus Torvalds 	case CPUFREQ_POLICY_NOTIFIER:
1690e041c683SAlan Stern 		ret = blocking_notifier_chain_register(
1691e041c683SAlan Stern 				&cpufreq_policy_notifier_list, nb);
16921da177e4SLinus Torvalds 		break;
16931da177e4SLinus Torvalds 	default:
16941da177e4SLinus Torvalds 		ret = -EINVAL;
16951da177e4SLinus Torvalds 	}
16961da177e4SLinus Torvalds 
16971da177e4SLinus Torvalds 	return ret;
16981da177e4SLinus Torvalds }
16991da177e4SLinus Torvalds EXPORT_SYMBOL(cpufreq_register_notifier);
17001da177e4SLinus Torvalds 
17011da177e4SLinus Torvalds /**
17021da177e4SLinus Torvalds  *	cpufreq_unregister_notifier - unregister a driver with cpufreq
17031da177e4SLinus Torvalds  *	@nb: notifier block to be unregistered
17041da177e4SLinus Torvalds  *	@list: CPUFREQ_TRANSITION_NOTIFIER or CPUFREQ_POLICY_NOTIFIER
17051da177e4SLinus Torvalds  *
17061da177e4SLinus Torvalds  *	Remove a driver from the CPU frequency notifier list.
17071da177e4SLinus Torvalds  *
17081da177e4SLinus Torvalds  *	This function may sleep, and has the same return conditions as
1709e041c683SAlan Stern  *	blocking_notifier_chain_unregister.
17101da177e4SLinus Torvalds  */
17111da177e4SLinus Torvalds int cpufreq_unregister_notifier(struct notifier_block *nb, unsigned int list)
17121da177e4SLinus Torvalds {
17131da177e4SLinus Torvalds 	int ret;
17141da177e4SLinus Torvalds 
1715d5aaffa9SDirk Brandewie 	if (cpufreq_disabled())
1716d5aaffa9SDirk Brandewie 		return -EINVAL;
1717d5aaffa9SDirk Brandewie 
17181da177e4SLinus Torvalds 	switch (list) {
17191da177e4SLinus Torvalds 	case CPUFREQ_TRANSITION_NOTIFIER:
1720b4dfdbb3SAlan Stern 		ret = srcu_notifier_chain_unregister(
1721e041c683SAlan Stern 				&cpufreq_transition_notifier_list, nb);
17221da177e4SLinus Torvalds 		break;
17231da177e4SLinus Torvalds 	case CPUFREQ_POLICY_NOTIFIER:
1724e041c683SAlan Stern 		ret = blocking_notifier_chain_unregister(
1725e041c683SAlan Stern 				&cpufreq_policy_notifier_list, nb);
17261da177e4SLinus Torvalds 		break;
17271da177e4SLinus Torvalds 	default:
17281da177e4SLinus Torvalds 		ret = -EINVAL;
17291da177e4SLinus Torvalds 	}
17301da177e4SLinus Torvalds 
17311da177e4SLinus Torvalds 	return ret;
17321da177e4SLinus Torvalds }
17331da177e4SLinus Torvalds EXPORT_SYMBOL(cpufreq_unregister_notifier);
17341da177e4SLinus Torvalds 
17351da177e4SLinus Torvalds 
17361da177e4SLinus Torvalds /*********************************************************************
17371da177e4SLinus Torvalds  *                              GOVERNORS                            *
17381da177e4SLinus Torvalds  *********************************************************************/
17391da177e4SLinus Torvalds 
17401da177e4SLinus Torvalds int __cpufreq_driver_target(struct cpufreq_policy *policy,
17411da177e4SLinus Torvalds 			    unsigned int target_freq,
17421da177e4SLinus Torvalds 			    unsigned int relation)
17431da177e4SLinus Torvalds {
17441da177e4SLinus Torvalds 	int retval = -EINVAL;
17457249924eSViresh Kumar 	unsigned int old_target_freq = target_freq;
1746c32b6b8eSAshok Raj 
1747a7b422cdSKonrad Rzeszutek Wilk 	if (cpufreq_disabled())
1748a7b422cdSKonrad Rzeszutek Wilk 		return -ENODEV;
1749a7b422cdSKonrad Rzeszutek Wilk 
17507249924eSViresh Kumar 	/* Make sure that target_freq is within supported range */
17517249924eSViresh Kumar 	if (target_freq > policy->max)
17527249924eSViresh Kumar 		target_freq = policy->max;
17537249924eSViresh Kumar 	if (target_freq < policy->min)
17547249924eSViresh Kumar 		target_freq = policy->min;
17557249924eSViresh Kumar 
17567249924eSViresh Kumar 	pr_debug("target for CPU %u: %u kHz, relation %u, requested %u kHz\n",
17577249924eSViresh Kumar 			policy->cpu, target_freq, relation, old_target_freq);
17585a1c0228SViresh Kumar 
17599c0ebcf7SViresh Kumar 	/*
17609c0ebcf7SViresh Kumar 	 * This might look like a redundant call as we are checking it again
17619c0ebcf7SViresh Kumar 	 * after finding index. But it is left intentionally for cases where
17629c0ebcf7SViresh Kumar 	 * exactly same freq is called again and so we can save on few function
17639c0ebcf7SViresh Kumar 	 * calls.
17649c0ebcf7SViresh Kumar 	 */
17655a1c0228SViresh Kumar 	if (target_freq == policy->cur)
17665a1c0228SViresh Kumar 		return 0;
17675a1c0228SViresh Kumar 
17681c3d85ddSRafael J. Wysocki 	if (cpufreq_driver->target)
17691c3d85ddSRafael J. Wysocki 		retval = cpufreq_driver->target(policy, target_freq, relation);
17709c0ebcf7SViresh Kumar 	else if (cpufreq_driver->target_index) {
17719c0ebcf7SViresh Kumar 		struct cpufreq_frequency_table *freq_table;
1772d4019f0aSViresh Kumar 		struct cpufreq_freqs freqs;
1773d4019f0aSViresh Kumar 		bool notify;
17749c0ebcf7SViresh Kumar 		int index;
177590d45d17SAshok Raj 
17769c0ebcf7SViresh Kumar 		freq_table = cpufreq_frequency_get_table(policy->cpu);
17779c0ebcf7SViresh Kumar 		if (unlikely(!freq_table)) {
17789c0ebcf7SViresh Kumar 			pr_err("%s: Unable to find freq_table\n", __func__);
17799c0ebcf7SViresh Kumar 			goto out;
17809c0ebcf7SViresh Kumar 		}
17819c0ebcf7SViresh Kumar 
17829c0ebcf7SViresh Kumar 		retval = cpufreq_frequency_table_target(policy, freq_table,
17839c0ebcf7SViresh Kumar 				target_freq, relation, &index);
17849c0ebcf7SViresh Kumar 		if (unlikely(retval)) {
17859c0ebcf7SViresh Kumar 			pr_err("%s: Unable to find matching freq\n", __func__);
17869c0ebcf7SViresh Kumar 			goto out;
17879c0ebcf7SViresh Kumar 		}
17889c0ebcf7SViresh Kumar 
1789d4019f0aSViresh Kumar 		if (freq_table[index].frequency == policy->cur) {
17909c0ebcf7SViresh Kumar 			retval = 0;
1791d4019f0aSViresh Kumar 			goto out;
1792d4019f0aSViresh Kumar 		}
1793d4019f0aSViresh Kumar 
1794d4019f0aSViresh Kumar 		notify = !(cpufreq_driver->flags & CPUFREQ_ASYNC_NOTIFICATION);
1795d4019f0aSViresh Kumar 
1796d4019f0aSViresh Kumar 		if (notify) {
1797d4019f0aSViresh Kumar 			freqs.old = policy->cur;
1798d4019f0aSViresh Kumar 			freqs.new = freq_table[index].frequency;
1799d4019f0aSViresh Kumar 			freqs.flags = 0;
1800d4019f0aSViresh Kumar 
1801d4019f0aSViresh Kumar 			pr_debug("%s: cpu: %d, oldfreq: %u, new freq: %u\n",
1802d4019f0aSViresh Kumar 					__func__, policy->cpu, freqs.old,
1803d4019f0aSViresh Kumar 					freqs.new);
1804d4019f0aSViresh Kumar 
1805d4019f0aSViresh Kumar 			cpufreq_notify_transition(policy, &freqs,
1806d4019f0aSViresh Kumar 					CPUFREQ_PRECHANGE);
1807d4019f0aSViresh Kumar 		}
1808d4019f0aSViresh Kumar 
18099c0ebcf7SViresh Kumar 		retval = cpufreq_driver->target_index(policy, index);
1810d4019f0aSViresh Kumar 		if (retval)
1811d4019f0aSViresh Kumar 			pr_err("%s: Failed to change cpu frequency: %d\n",
1812d4019f0aSViresh Kumar 					__func__, retval);
1813d4019f0aSViresh Kumar 
1814ab1b1c4eSViresh Kumar 		if (notify)
1815ab1b1c4eSViresh Kumar 			cpufreq_notify_post_transition(policy, &freqs, retval);
18169c0ebcf7SViresh Kumar 	}
18179c0ebcf7SViresh Kumar 
18189c0ebcf7SViresh Kumar out:
18191da177e4SLinus Torvalds 	return retval;
18201da177e4SLinus Torvalds }
18211da177e4SLinus Torvalds EXPORT_SYMBOL_GPL(__cpufreq_driver_target);
18221da177e4SLinus Torvalds 
18231da177e4SLinus Torvalds int cpufreq_driver_target(struct cpufreq_policy *policy,
18241da177e4SLinus Torvalds 			  unsigned int target_freq,
18251da177e4SLinus Torvalds 			  unsigned int relation)
18261da177e4SLinus Torvalds {
1827f1829e4aSJulia Lawall 	int ret = -EINVAL;
18281da177e4SLinus Torvalds 
1829ad7722daSviresh kumar 	down_write(&policy->rwsem);
18301da177e4SLinus Torvalds 
18311da177e4SLinus Torvalds 	ret = __cpufreq_driver_target(policy, target_freq, relation);
18321da177e4SLinus Torvalds 
1833ad7722daSviresh kumar 	up_write(&policy->rwsem);
18341da177e4SLinus Torvalds 
18351da177e4SLinus Torvalds 	return ret;
18361da177e4SLinus Torvalds }
18371da177e4SLinus Torvalds EXPORT_SYMBOL_GPL(cpufreq_driver_target);
18381da177e4SLinus Torvalds 
1839153d7f3fSArjan van de Ven /*
1840153d7f3fSArjan van de Ven  * when "event" is CPUFREQ_GOV_LIMITS
1841153d7f3fSArjan van de Ven  */
18421da177e4SLinus Torvalds 
1843e08f5f5bSGautham R Shenoy static int __cpufreq_governor(struct cpufreq_policy *policy,
1844e08f5f5bSGautham R Shenoy 					unsigned int event)
18451da177e4SLinus Torvalds {
1846cc993cabSDave Jones 	int ret;
18476afde10cSThomas Renninger 
18486afde10cSThomas Renninger 	/* Only must be defined when default governor is known to have latency
18496afde10cSThomas Renninger 	   restrictions, like e.g. conservative or ondemand.
18506afde10cSThomas Renninger 	   That this is the case is already ensured in Kconfig
18516afde10cSThomas Renninger 	*/
18526afde10cSThomas Renninger #ifdef CONFIG_CPU_FREQ_GOV_PERFORMANCE
18536afde10cSThomas Renninger 	struct cpufreq_governor *gov = &cpufreq_gov_performance;
18546afde10cSThomas Renninger #else
18556afde10cSThomas Renninger 	struct cpufreq_governor *gov = NULL;
18566afde10cSThomas Renninger #endif
18571c256245SThomas Renninger 
1858*2f0aea93SViresh Kumar 	/* Don't start any governor operations if we are entering suspend */
1859*2f0aea93SViresh Kumar 	if (cpufreq_suspended)
1860*2f0aea93SViresh Kumar 		return 0;
1861*2f0aea93SViresh Kumar 
18621c256245SThomas Renninger 	if (policy->governor->max_transition_latency &&
18631c256245SThomas Renninger 	    policy->cpuinfo.transition_latency >
18641c256245SThomas Renninger 	    policy->governor->max_transition_latency) {
18656afde10cSThomas Renninger 		if (!gov)
18666afde10cSThomas Renninger 			return -EINVAL;
18676afde10cSThomas Renninger 		else {
18681c256245SThomas Renninger 			printk(KERN_WARNING "%s governor failed, too long"
18691c256245SThomas Renninger 			       " transition latency of HW, fallback"
18701c256245SThomas Renninger 			       " to %s governor\n",
18711c256245SThomas Renninger 			       policy->governor->name,
18721c256245SThomas Renninger 			       gov->name);
18731c256245SThomas Renninger 			policy->governor = gov;
18741c256245SThomas Renninger 		}
18756afde10cSThomas Renninger 	}
18761da177e4SLinus Torvalds 
1877fe492f3fSViresh Kumar 	if (event == CPUFREQ_GOV_POLICY_INIT)
18781da177e4SLinus Torvalds 		if (!try_module_get(policy->governor->owner))
18791da177e4SLinus Torvalds 			return -EINVAL;
18801da177e4SLinus Torvalds 
18812d06d8c4SDominik Brodowski 	pr_debug("__cpufreq_governor for CPU %u, event %u\n",
1882e08f5f5bSGautham R Shenoy 						policy->cpu, event);
188395731ebbSXiaoguang Chen 
188495731ebbSXiaoguang Chen 	mutex_lock(&cpufreq_governor_lock);
188556d07db2SSrivatsa S. Bhat 	if ((policy->governor_enabled && event == CPUFREQ_GOV_START)
1886f73d3933SViresh Kumar 	    || (!policy->governor_enabled
1887f73d3933SViresh Kumar 	    && (event == CPUFREQ_GOV_LIMITS || event == CPUFREQ_GOV_STOP))) {
188895731ebbSXiaoguang Chen 		mutex_unlock(&cpufreq_governor_lock);
188995731ebbSXiaoguang Chen 		return -EBUSY;
189095731ebbSXiaoguang Chen 	}
189195731ebbSXiaoguang Chen 
189295731ebbSXiaoguang Chen 	if (event == CPUFREQ_GOV_STOP)
189395731ebbSXiaoguang Chen 		policy->governor_enabled = false;
189495731ebbSXiaoguang Chen 	else if (event == CPUFREQ_GOV_START)
189595731ebbSXiaoguang Chen 		policy->governor_enabled = true;
189695731ebbSXiaoguang Chen 
189795731ebbSXiaoguang Chen 	mutex_unlock(&cpufreq_governor_lock);
189895731ebbSXiaoguang Chen 
18991da177e4SLinus Torvalds 	ret = policy->governor->governor(policy, event);
19001da177e4SLinus Torvalds 
19014d5dcc42SViresh Kumar 	if (!ret) {
19024d5dcc42SViresh Kumar 		if (event == CPUFREQ_GOV_POLICY_INIT)
19038e53695fSViresh Kumar 			policy->governor->initialized++;
19044d5dcc42SViresh Kumar 		else if (event == CPUFREQ_GOV_POLICY_EXIT)
19058e53695fSViresh Kumar 			policy->governor->initialized--;
190695731ebbSXiaoguang Chen 	} else {
190795731ebbSXiaoguang Chen 		/* Restore original values */
190895731ebbSXiaoguang Chen 		mutex_lock(&cpufreq_governor_lock);
190995731ebbSXiaoguang Chen 		if (event == CPUFREQ_GOV_STOP)
191095731ebbSXiaoguang Chen 			policy->governor_enabled = true;
191195731ebbSXiaoguang Chen 		else if (event == CPUFREQ_GOV_START)
191295731ebbSXiaoguang Chen 			policy->governor_enabled = false;
191395731ebbSXiaoguang Chen 		mutex_unlock(&cpufreq_governor_lock);
19144d5dcc42SViresh Kumar 	}
1915b394058fSViresh Kumar 
1916fe492f3fSViresh Kumar 	if (((event == CPUFREQ_GOV_POLICY_INIT) && ret) ||
1917fe492f3fSViresh Kumar 			((event == CPUFREQ_GOV_POLICY_EXIT) && !ret))
19181da177e4SLinus Torvalds 		module_put(policy->governor->owner);
19191da177e4SLinus Torvalds 
19201da177e4SLinus Torvalds 	return ret;
19211da177e4SLinus Torvalds }
19221da177e4SLinus Torvalds 
19231da177e4SLinus Torvalds int cpufreq_register_governor(struct cpufreq_governor *governor)
19241da177e4SLinus Torvalds {
19253bcb09a3SJeremy Fitzhardinge 	int err;
19261da177e4SLinus Torvalds 
19271da177e4SLinus Torvalds 	if (!governor)
19281da177e4SLinus Torvalds 		return -EINVAL;
19291da177e4SLinus Torvalds 
1930a7b422cdSKonrad Rzeszutek Wilk 	if (cpufreq_disabled())
1931a7b422cdSKonrad Rzeszutek Wilk 		return -ENODEV;
1932a7b422cdSKonrad Rzeszutek Wilk 
19333fc54d37Sakpm@osdl.org 	mutex_lock(&cpufreq_governor_mutex);
19341da177e4SLinus Torvalds 
1935b394058fSViresh Kumar 	governor->initialized = 0;
19363bcb09a3SJeremy Fitzhardinge 	err = -EBUSY;
19373bcb09a3SJeremy Fitzhardinge 	if (__find_governor(governor->name) == NULL) {
19383bcb09a3SJeremy Fitzhardinge 		err = 0;
19391da177e4SLinus Torvalds 		list_add(&governor->governor_list, &cpufreq_governor_list);
19403bcb09a3SJeremy Fitzhardinge 	}
19411da177e4SLinus Torvalds 
19423fc54d37Sakpm@osdl.org 	mutex_unlock(&cpufreq_governor_mutex);
19433bcb09a3SJeremy Fitzhardinge 	return err;
19441da177e4SLinus Torvalds }
19451da177e4SLinus Torvalds EXPORT_SYMBOL_GPL(cpufreq_register_governor);
19461da177e4SLinus Torvalds 
19471da177e4SLinus Torvalds void cpufreq_unregister_governor(struct cpufreq_governor *governor)
19481da177e4SLinus Torvalds {
194990e41bacSPrarit Bhargava 	int cpu;
195090e41bacSPrarit Bhargava 
19511da177e4SLinus Torvalds 	if (!governor)
19521da177e4SLinus Torvalds 		return;
19531da177e4SLinus Torvalds 
1954a7b422cdSKonrad Rzeszutek Wilk 	if (cpufreq_disabled())
1955a7b422cdSKonrad Rzeszutek Wilk 		return;
1956a7b422cdSKonrad Rzeszutek Wilk 
195790e41bacSPrarit Bhargava 	for_each_present_cpu(cpu) {
195890e41bacSPrarit Bhargava 		if (cpu_online(cpu))
195990e41bacSPrarit Bhargava 			continue;
196090e41bacSPrarit Bhargava 		if (!strcmp(per_cpu(cpufreq_cpu_governor, cpu), governor->name))
196190e41bacSPrarit Bhargava 			strcpy(per_cpu(cpufreq_cpu_governor, cpu), "\0");
196290e41bacSPrarit Bhargava 	}
196390e41bacSPrarit Bhargava 
19643fc54d37Sakpm@osdl.org 	mutex_lock(&cpufreq_governor_mutex);
19651da177e4SLinus Torvalds 	list_del(&governor->governor_list);
19663fc54d37Sakpm@osdl.org 	mutex_unlock(&cpufreq_governor_mutex);
19671da177e4SLinus Torvalds 	return;
19681da177e4SLinus Torvalds }
19691da177e4SLinus Torvalds EXPORT_SYMBOL_GPL(cpufreq_unregister_governor);
19701da177e4SLinus Torvalds 
19711da177e4SLinus Torvalds 
19721da177e4SLinus Torvalds /*********************************************************************
19731da177e4SLinus Torvalds  *                          POLICY INTERFACE                         *
19741da177e4SLinus Torvalds  *********************************************************************/
19751da177e4SLinus Torvalds 
19761da177e4SLinus Torvalds /**
19771da177e4SLinus Torvalds  * cpufreq_get_policy - get the current cpufreq_policy
197829464f28SDave Jones  * @policy: struct cpufreq_policy into which the current cpufreq_policy
197929464f28SDave Jones  *	is written
19801da177e4SLinus Torvalds  *
19811da177e4SLinus Torvalds  * Reads the current cpufreq policy.
19821da177e4SLinus Torvalds  */
19831da177e4SLinus Torvalds int cpufreq_get_policy(struct cpufreq_policy *policy, unsigned int cpu)
19841da177e4SLinus Torvalds {
19851da177e4SLinus Torvalds 	struct cpufreq_policy *cpu_policy;
19861da177e4SLinus Torvalds 	if (!policy)
19871da177e4SLinus Torvalds 		return -EINVAL;
19881da177e4SLinus Torvalds 
19891da177e4SLinus Torvalds 	cpu_policy = cpufreq_cpu_get(cpu);
19901da177e4SLinus Torvalds 	if (!cpu_policy)
19911da177e4SLinus Torvalds 		return -EINVAL;
19921da177e4SLinus Torvalds 
1993d5b73cd8SViresh Kumar 	memcpy(policy, cpu_policy, sizeof(*policy));
19941da177e4SLinus Torvalds 
19951da177e4SLinus Torvalds 	cpufreq_cpu_put(cpu_policy);
19961da177e4SLinus Torvalds 	return 0;
19971da177e4SLinus Torvalds }
19981da177e4SLinus Torvalds EXPORT_SYMBOL(cpufreq_get_policy);
19991da177e4SLinus Torvalds 
2000153d7f3fSArjan van de Ven /*
2001037ce839SViresh Kumar  * policy : current policy.
2002037ce839SViresh Kumar  * new_policy: policy to be set.
2003153d7f3fSArjan van de Ven  */
2004037ce839SViresh Kumar static int cpufreq_set_policy(struct cpufreq_policy *policy,
20053a3e9e06SViresh Kumar 				struct cpufreq_policy *new_policy)
20061da177e4SLinus Torvalds {
2007d9a789c7SRafael J. Wysocki 	struct cpufreq_governor *old_gov;
2008d9a789c7SRafael J. Wysocki 	int ret;
20091da177e4SLinus Torvalds 
20103a3e9e06SViresh Kumar 	pr_debug("setting new policy for CPU %u: %u - %u kHz\n", new_policy->cpu,
20113a3e9e06SViresh Kumar 		new_policy->min, new_policy->max);
20121da177e4SLinus Torvalds 
2013d5b73cd8SViresh Kumar 	memcpy(&new_policy->cpuinfo, &policy->cpuinfo, sizeof(policy->cpuinfo));
20141da177e4SLinus Torvalds 
2015d9a789c7SRafael J. Wysocki 	if (new_policy->min > policy->max || new_policy->max < policy->min)
2016d9a789c7SRafael J. Wysocki 		return -EINVAL;
20179c9a43edSMattia Dongili 
20181da177e4SLinus Torvalds 	/* verify the cpu speed can be set within this limit */
20193a3e9e06SViresh Kumar 	ret = cpufreq_driver->verify(new_policy);
20201da177e4SLinus Torvalds 	if (ret)
2021d9a789c7SRafael J. Wysocki 		return ret;
20221da177e4SLinus Torvalds 
20231da177e4SLinus Torvalds 	/* adjust if necessary - all reasons */
2024e041c683SAlan Stern 	blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
20253a3e9e06SViresh Kumar 			CPUFREQ_ADJUST, new_policy);
20261da177e4SLinus Torvalds 
20271da177e4SLinus Torvalds 	/* adjust if necessary - hardware incompatibility*/
2028e041c683SAlan Stern 	blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
20293a3e9e06SViresh Kumar 			CPUFREQ_INCOMPATIBLE, new_policy);
20301da177e4SLinus Torvalds 
2031bb176f7dSViresh Kumar 	/*
2032bb176f7dSViresh Kumar 	 * verify the cpu speed can be set within this limit, which might be
2033bb176f7dSViresh Kumar 	 * different to the first one
2034bb176f7dSViresh Kumar 	 */
20353a3e9e06SViresh Kumar 	ret = cpufreq_driver->verify(new_policy);
2036e041c683SAlan Stern 	if (ret)
2037d9a789c7SRafael J. Wysocki 		return ret;
20381da177e4SLinus Torvalds 
20391da177e4SLinus Torvalds 	/* notification of the new policy */
2040e041c683SAlan Stern 	blocking_notifier_call_chain(&cpufreq_policy_notifier_list,
20413a3e9e06SViresh Kumar 			CPUFREQ_NOTIFY, new_policy);
20421da177e4SLinus Torvalds 
20433a3e9e06SViresh Kumar 	policy->min = new_policy->min;
20443a3e9e06SViresh Kumar 	policy->max = new_policy->max;
20451da177e4SLinus Torvalds 
20462d06d8c4SDominik Brodowski 	pr_debug("new min and max freqs are %u - %u kHz\n",
20473a3e9e06SViresh Kumar 					policy->min, policy->max);
20481da177e4SLinus Torvalds 
20491c3d85ddSRafael J. Wysocki 	if (cpufreq_driver->setpolicy) {
20503a3e9e06SViresh Kumar 		policy->policy = new_policy->policy;
20512d06d8c4SDominik Brodowski 		pr_debug("setting range\n");
2052d9a789c7SRafael J. Wysocki 		return cpufreq_driver->setpolicy(new_policy);
2053d9a789c7SRafael J. Wysocki 	}
2054d9a789c7SRafael J. Wysocki 
2055d9a789c7SRafael J. Wysocki 	if (new_policy->governor == policy->governor)
2056d9a789c7SRafael J. Wysocki 		goto out;
20571da177e4SLinus Torvalds 
20582d06d8c4SDominik Brodowski 	pr_debug("governor switch\n");
20591da177e4SLinus Torvalds 
2060d9a789c7SRafael J. Wysocki 	/* save old, working values */
2061d9a789c7SRafael J. Wysocki 	old_gov = policy->governor;
20621da177e4SLinus Torvalds 	/* end old governor */
2063d9a789c7SRafael J. Wysocki 	if (old_gov) {
20643a3e9e06SViresh Kumar 		__cpufreq_governor(policy, CPUFREQ_GOV_STOP);
2065ad7722daSviresh kumar 		up_write(&policy->rwsem);
2066d9a789c7SRafael J. Wysocki 		__cpufreq_governor(policy,CPUFREQ_GOV_POLICY_EXIT);
2067ad7722daSviresh kumar 		down_write(&policy->rwsem);
20687bd353a9SViresh Kumar 	}
20691da177e4SLinus Torvalds 
20701da177e4SLinus Torvalds 	/* start new governor */
20713a3e9e06SViresh Kumar 	policy->governor = new_policy->governor;
20723a3e9e06SViresh Kumar 	if (!__cpufreq_governor(policy, CPUFREQ_GOV_POLICY_INIT)) {
2073d9a789c7SRafael J. Wysocki 		if (!__cpufreq_governor(policy, CPUFREQ_GOV_START))
2074d9a789c7SRafael J. Wysocki 			goto out;
2075d9a789c7SRafael J. Wysocki 
2076ad7722daSviresh kumar 		up_write(&policy->rwsem);
2077d9a789c7SRafael J. Wysocki 		__cpufreq_governor(policy, CPUFREQ_GOV_POLICY_EXIT);
2078ad7722daSviresh kumar 		down_write(&policy->rwsem);
2079955ef483SViresh Kumar 	}
20807bd353a9SViresh Kumar 
20811da177e4SLinus Torvalds 	/* new governor failed, so re-start old one */
2082d9a789c7SRafael J. Wysocki 	pr_debug("starting governor %s failed\n", policy->governor->name);
20831da177e4SLinus Torvalds 	if (old_gov) {
20843a3e9e06SViresh Kumar 		policy->governor = old_gov;
2085d9a789c7SRafael J. Wysocki 		__cpufreq_governor(policy, CPUFREQ_GOV_POLICY_INIT);
2086d9a789c7SRafael J. Wysocki 		__cpufreq_governor(policy, CPUFREQ_GOV_START);
20871da177e4SLinus Torvalds 	}
20881da177e4SLinus Torvalds 
2089d9a789c7SRafael J. Wysocki 	return -EINVAL;
2090d9a789c7SRafael J. Wysocki 
2091d9a789c7SRafael J. Wysocki  out:
2092d9a789c7SRafael J. Wysocki 	pr_debug("governor: change or update limits\n");
2093d9a789c7SRafael J. Wysocki 	return __cpufreq_governor(policy, CPUFREQ_GOV_LIMITS);
20941da177e4SLinus Torvalds }
20951da177e4SLinus Torvalds 
20961da177e4SLinus Torvalds /**
20971da177e4SLinus Torvalds  *	cpufreq_update_policy - re-evaluate an existing cpufreq policy
20981da177e4SLinus Torvalds  *	@cpu: CPU which shall be re-evaluated
20991da177e4SLinus Torvalds  *
210025985edcSLucas De Marchi  *	Useful for policy notifiers which have different necessities
21011da177e4SLinus Torvalds  *	at different times.
21021da177e4SLinus Torvalds  */
21031da177e4SLinus Torvalds int cpufreq_update_policy(unsigned int cpu)
21041da177e4SLinus Torvalds {
21053a3e9e06SViresh Kumar 	struct cpufreq_policy *policy = cpufreq_cpu_get(cpu);
21063a3e9e06SViresh Kumar 	struct cpufreq_policy new_policy;
2107f1829e4aSJulia Lawall 	int ret;
21081da177e4SLinus Torvalds 
21093a3e9e06SViresh Kumar 	if (!policy) {
2110f1829e4aSJulia Lawall 		ret = -ENODEV;
2111f1829e4aSJulia Lawall 		goto no_policy;
2112f1829e4aSJulia Lawall 	}
21131da177e4SLinus Torvalds 
2114ad7722daSviresh kumar 	down_write(&policy->rwsem);
21151da177e4SLinus Torvalds 
21162d06d8c4SDominik Brodowski 	pr_debug("updating policy for CPU %u\n", cpu);
2117d5b73cd8SViresh Kumar 	memcpy(&new_policy, policy, sizeof(*policy));
21183a3e9e06SViresh Kumar 	new_policy.min = policy->user_policy.min;
21193a3e9e06SViresh Kumar 	new_policy.max = policy->user_policy.max;
21203a3e9e06SViresh Kumar 	new_policy.policy = policy->user_policy.policy;
21213a3e9e06SViresh Kumar 	new_policy.governor = policy->user_policy.governor;
21221da177e4SLinus Torvalds 
2123bb176f7dSViresh Kumar 	/*
2124bb176f7dSViresh Kumar 	 * BIOS might change freq behind our back
2125bb176f7dSViresh Kumar 	 * -> ask driver for current freq and notify governors about a change
2126bb176f7dSViresh Kumar 	 */
21271c3d85ddSRafael J. Wysocki 	if (cpufreq_driver->get) {
21283a3e9e06SViresh Kumar 		new_policy.cur = cpufreq_driver->get(cpu);
2129bd0fa9bbSViresh Kumar 		if (WARN_ON(!new_policy.cur)) {
2130bd0fa9bbSViresh Kumar 			ret = -EIO;
2131bd0fa9bbSViresh Kumar 			goto no_policy;
2132bd0fa9bbSViresh Kumar 		}
2133bd0fa9bbSViresh Kumar 
21343a3e9e06SViresh Kumar 		if (!policy->cur) {
21352d06d8c4SDominik Brodowski 			pr_debug("Driver did not initialize current freq");
21363a3e9e06SViresh Kumar 			policy->cur = new_policy.cur;
2137a85f7bd3SThomas Renninger 		} else {
21389c0ebcf7SViresh Kumar 			if (policy->cur != new_policy.cur && has_target())
21393a3e9e06SViresh Kumar 				cpufreq_out_of_sync(cpu, policy->cur,
21403a3e9e06SViresh Kumar 								new_policy.cur);
21410961dd0dSThomas Renninger 		}
2142a85f7bd3SThomas Renninger 	}
21430961dd0dSThomas Renninger 
2144037ce839SViresh Kumar 	ret = cpufreq_set_policy(policy, &new_policy);
21451da177e4SLinus Torvalds 
2146ad7722daSviresh kumar 	up_write(&policy->rwsem);
21475a01f2e8SVenkatesh Pallipadi 
21483a3e9e06SViresh Kumar 	cpufreq_cpu_put(policy);
2149f1829e4aSJulia Lawall no_policy:
21501da177e4SLinus Torvalds 	return ret;
21511da177e4SLinus Torvalds }
21521da177e4SLinus Torvalds EXPORT_SYMBOL(cpufreq_update_policy);
21531da177e4SLinus Torvalds 
21542760984fSPaul Gortmaker static int cpufreq_cpu_callback(struct notifier_block *nfb,
2155c32b6b8eSAshok Raj 					unsigned long action, void *hcpu)
2156c32b6b8eSAshok Raj {
2157c32b6b8eSAshok Raj 	unsigned int cpu = (unsigned long)hcpu;
21588a25a2fdSKay Sievers 	struct device *dev;
21595302c3fbSSrivatsa S. Bhat 	bool frozen = false;
2160c32b6b8eSAshok Raj 
21618a25a2fdSKay Sievers 	dev = get_cpu_device(cpu);
21628a25a2fdSKay Sievers 	if (dev) {
21635302c3fbSSrivatsa S. Bhat 
2164d4faadd5SRafael J. Wysocki 		if (action & CPU_TASKS_FROZEN)
2165d4faadd5SRafael J. Wysocki 			frozen = true;
2166d4faadd5SRafael J. Wysocki 
21675302c3fbSSrivatsa S. Bhat 		switch (action & ~CPU_TASKS_FROZEN) {
2168c32b6b8eSAshok Raj 		case CPU_ONLINE:
21695302c3fbSSrivatsa S. Bhat 			__cpufreq_add_dev(dev, NULL, frozen);
2170c32b6b8eSAshok Raj 			break;
21715302c3fbSSrivatsa S. Bhat 
2172c32b6b8eSAshok Raj 		case CPU_DOWN_PREPARE:
2173cedb70afSSrivatsa S. Bhat 			__cpufreq_remove_dev_prepare(dev, NULL, frozen);
21741aee40acSSrivatsa S. Bhat 			break;
21751aee40acSSrivatsa S. Bhat 
21761aee40acSSrivatsa S. Bhat 		case CPU_POST_DEAD:
2177cedb70afSSrivatsa S. Bhat 			__cpufreq_remove_dev_finish(dev, NULL, frozen);
2178c32b6b8eSAshok Raj 			break;
21795302c3fbSSrivatsa S. Bhat 
21805a01f2e8SVenkatesh Pallipadi 		case CPU_DOWN_FAILED:
21815302c3fbSSrivatsa S. Bhat 			__cpufreq_add_dev(dev, NULL, frozen);
2182c32b6b8eSAshok Raj 			break;
2183c32b6b8eSAshok Raj 		}
2184c32b6b8eSAshok Raj 	}
2185c32b6b8eSAshok Raj 	return NOTIFY_OK;
2186c32b6b8eSAshok Raj }
2187c32b6b8eSAshok Raj 
21889c36f746SNeal Buckendahl static struct notifier_block __refdata cpufreq_cpu_notifier = {
2189c32b6b8eSAshok Raj 	.notifier_call = cpufreq_cpu_callback,
2190c32b6b8eSAshok Raj };
21911da177e4SLinus Torvalds 
21921da177e4SLinus Torvalds /*********************************************************************
21936f19efc0SLukasz Majewski  *               BOOST						     *
21946f19efc0SLukasz Majewski  *********************************************************************/
21956f19efc0SLukasz Majewski static int cpufreq_boost_set_sw(int state)
21966f19efc0SLukasz Majewski {
21976f19efc0SLukasz Majewski 	struct cpufreq_frequency_table *freq_table;
21986f19efc0SLukasz Majewski 	struct cpufreq_policy *policy;
21996f19efc0SLukasz Majewski 	int ret = -EINVAL;
22006f19efc0SLukasz Majewski 
22016f19efc0SLukasz Majewski 	list_for_each_entry(policy, &cpufreq_policy_list, policy_list) {
22026f19efc0SLukasz Majewski 		freq_table = cpufreq_frequency_get_table(policy->cpu);
22036f19efc0SLukasz Majewski 		if (freq_table) {
22046f19efc0SLukasz Majewski 			ret = cpufreq_frequency_table_cpuinfo(policy,
22056f19efc0SLukasz Majewski 							freq_table);
22066f19efc0SLukasz Majewski 			if (ret) {
22076f19efc0SLukasz Majewski 				pr_err("%s: Policy frequency update failed\n",
22086f19efc0SLukasz Majewski 				       __func__);
22096f19efc0SLukasz Majewski 				break;
22106f19efc0SLukasz Majewski 			}
22116f19efc0SLukasz Majewski 			policy->user_policy.max = policy->max;
22126f19efc0SLukasz Majewski 			__cpufreq_governor(policy, CPUFREQ_GOV_LIMITS);
22136f19efc0SLukasz Majewski 		}
22146f19efc0SLukasz Majewski 	}
22156f19efc0SLukasz Majewski 
22166f19efc0SLukasz Majewski 	return ret;
22176f19efc0SLukasz Majewski }
22186f19efc0SLukasz Majewski 
22196f19efc0SLukasz Majewski int cpufreq_boost_trigger_state(int state)
22206f19efc0SLukasz Majewski {
22216f19efc0SLukasz Majewski 	unsigned long flags;
22226f19efc0SLukasz Majewski 	int ret = 0;
22236f19efc0SLukasz Majewski 
22246f19efc0SLukasz Majewski 	if (cpufreq_driver->boost_enabled == state)
22256f19efc0SLukasz Majewski 		return 0;
22266f19efc0SLukasz Majewski 
22276f19efc0SLukasz Majewski 	write_lock_irqsave(&cpufreq_driver_lock, flags);
22286f19efc0SLukasz Majewski 	cpufreq_driver->boost_enabled = state;
22296f19efc0SLukasz Majewski 	write_unlock_irqrestore(&cpufreq_driver_lock, flags);
22306f19efc0SLukasz Majewski 
22316f19efc0SLukasz Majewski 	ret = cpufreq_driver->set_boost(state);
22326f19efc0SLukasz Majewski 	if (ret) {
22336f19efc0SLukasz Majewski 		write_lock_irqsave(&cpufreq_driver_lock, flags);
22346f19efc0SLukasz Majewski 		cpufreq_driver->boost_enabled = !state;
22356f19efc0SLukasz Majewski 		write_unlock_irqrestore(&cpufreq_driver_lock, flags);
22366f19efc0SLukasz Majewski 
22376f19efc0SLukasz Majewski 		pr_err("%s: Cannot %s BOOST\n", __func__,
22386f19efc0SLukasz Majewski 		       state ? "enable" : "disable");
22396f19efc0SLukasz Majewski 	}
22406f19efc0SLukasz Majewski 
22416f19efc0SLukasz Majewski 	return ret;
22426f19efc0SLukasz Majewski }
22436f19efc0SLukasz Majewski 
22446f19efc0SLukasz Majewski int cpufreq_boost_supported(void)
22456f19efc0SLukasz Majewski {
22466f19efc0SLukasz Majewski 	if (likely(cpufreq_driver))
22476f19efc0SLukasz Majewski 		return cpufreq_driver->boost_supported;
22486f19efc0SLukasz Majewski 
22496f19efc0SLukasz Majewski 	return 0;
22506f19efc0SLukasz Majewski }
22516f19efc0SLukasz Majewski EXPORT_SYMBOL_GPL(cpufreq_boost_supported);
22526f19efc0SLukasz Majewski 
22536f19efc0SLukasz Majewski int cpufreq_boost_enabled(void)
22546f19efc0SLukasz Majewski {
22556f19efc0SLukasz Majewski 	return cpufreq_driver->boost_enabled;
22566f19efc0SLukasz Majewski }
22576f19efc0SLukasz Majewski EXPORT_SYMBOL_GPL(cpufreq_boost_enabled);
22586f19efc0SLukasz Majewski 
22596f19efc0SLukasz Majewski /*********************************************************************
22601da177e4SLinus Torvalds  *               REGISTER / UNREGISTER CPUFREQ DRIVER                *
22611da177e4SLinus Torvalds  *********************************************************************/
22621da177e4SLinus Torvalds 
22631da177e4SLinus Torvalds /**
22641da177e4SLinus Torvalds  * cpufreq_register_driver - register a CPU Frequency driver
22651da177e4SLinus Torvalds  * @driver_data: A struct cpufreq_driver containing the values#
22661da177e4SLinus Torvalds  * submitted by the CPU Frequency driver.
22671da177e4SLinus Torvalds  *
22681da177e4SLinus Torvalds  * Registers a CPU Frequency driver to this core code. This code
22691da177e4SLinus Torvalds  * returns zero on success, -EBUSY when another driver got here first
22701da177e4SLinus Torvalds  * (and isn't unregistered in the meantime).
22711da177e4SLinus Torvalds  *
22721da177e4SLinus Torvalds  */
2273221dee28SLinus Torvalds int cpufreq_register_driver(struct cpufreq_driver *driver_data)
22741da177e4SLinus Torvalds {
22751da177e4SLinus Torvalds 	unsigned long flags;
22761da177e4SLinus Torvalds 	int ret;
22771da177e4SLinus Torvalds 
2278a7b422cdSKonrad Rzeszutek Wilk 	if (cpufreq_disabled())
2279a7b422cdSKonrad Rzeszutek Wilk 		return -ENODEV;
2280a7b422cdSKonrad Rzeszutek Wilk 
22811da177e4SLinus Torvalds 	if (!driver_data || !driver_data->verify || !driver_data->init ||
22829c0ebcf7SViresh Kumar 	    !(driver_data->setpolicy || driver_data->target_index ||
22839c0ebcf7SViresh Kumar 		    driver_data->target))
22841da177e4SLinus Torvalds 		return -EINVAL;
22851da177e4SLinus Torvalds 
22862d06d8c4SDominik Brodowski 	pr_debug("trying to register driver %s\n", driver_data->name);
22871da177e4SLinus Torvalds 
22881da177e4SLinus Torvalds 	if (driver_data->setpolicy)
22891da177e4SLinus Torvalds 		driver_data->flags |= CPUFREQ_CONST_LOOPS;
22901da177e4SLinus Torvalds 
22910d1857a1SNathan Zimmer 	write_lock_irqsave(&cpufreq_driver_lock, flags);
22921c3d85ddSRafael J. Wysocki 	if (cpufreq_driver) {
22930d1857a1SNathan Zimmer 		write_unlock_irqrestore(&cpufreq_driver_lock, flags);
22944dea5806SYinghai Lu 		return -EEXIST;
22951da177e4SLinus Torvalds 	}
22961c3d85ddSRafael J. Wysocki 	cpufreq_driver = driver_data;
22970d1857a1SNathan Zimmer 	write_unlock_irqrestore(&cpufreq_driver_lock, flags);
22981da177e4SLinus Torvalds 
22996f19efc0SLukasz Majewski 	if (cpufreq_boost_supported()) {
23006f19efc0SLukasz Majewski 		/*
23016f19efc0SLukasz Majewski 		 * Check if driver provides function to enable boost -
23026f19efc0SLukasz Majewski 		 * if not, use cpufreq_boost_set_sw as default
23036f19efc0SLukasz Majewski 		 */
23046f19efc0SLukasz Majewski 		if (!cpufreq_driver->set_boost)
23056f19efc0SLukasz Majewski 			cpufreq_driver->set_boost = cpufreq_boost_set_sw;
23066f19efc0SLukasz Majewski 
23076f19efc0SLukasz Majewski 		ret = cpufreq_sysfs_create_file(&boost.attr);
23086f19efc0SLukasz Majewski 		if (ret) {
23096f19efc0SLukasz Majewski 			pr_err("%s: cannot register global BOOST sysfs file\n",
23106f19efc0SLukasz Majewski 				__func__);
23116f19efc0SLukasz Majewski 			goto err_null_driver;
23126f19efc0SLukasz Majewski 		}
23136f19efc0SLukasz Majewski 	}
23146f19efc0SLukasz Majewski 
23158a25a2fdSKay Sievers 	ret = subsys_interface_register(&cpufreq_interface);
23168f5bc2abSJiri Slaby 	if (ret)
23176f19efc0SLukasz Majewski 		goto err_boost_unreg;
23181da177e4SLinus Torvalds 
23191c3d85ddSRafael J. Wysocki 	if (!(cpufreq_driver->flags & CPUFREQ_STICKY)) {
23201da177e4SLinus Torvalds 		int i;
23211da177e4SLinus Torvalds 		ret = -ENODEV;
23221da177e4SLinus Torvalds 
23231da177e4SLinus Torvalds 		/* check for at least one working CPU */
23247a6aedfaSMike Travis 		for (i = 0; i < nr_cpu_ids; i++)
23257a6aedfaSMike Travis 			if (cpu_possible(i) && per_cpu(cpufreq_cpu_data, i)) {
23261da177e4SLinus Torvalds 				ret = 0;
23277a6aedfaSMike Travis 				break;
23287a6aedfaSMike Travis 			}
23291da177e4SLinus Torvalds 
23301da177e4SLinus Torvalds 		/* if all ->init() calls failed, unregister */
23311da177e4SLinus Torvalds 		if (ret) {
23322d06d8c4SDominik Brodowski 			pr_debug("no CPU initialized for driver %s\n",
2333e08f5f5bSGautham R Shenoy 							driver_data->name);
23348a25a2fdSKay Sievers 			goto err_if_unreg;
23351da177e4SLinus Torvalds 		}
23361da177e4SLinus Torvalds 	}
23371da177e4SLinus Torvalds 
233865edc68cSChandra Seetharaman 	register_hotcpu_notifier(&cpufreq_cpu_notifier);
23392d06d8c4SDominik Brodowski 	pr_debug("driver %s up and running\n", driver_data->name);
23401da177e4SLinus Torvalds 
23418f5bc2abSJiri Slaby 	return 0;
23428a25a2fdSKay Sievers err_if_unreg:
23438a25a2fdSKay Sievers 	subsys_interface_unregister(&cpufreq_interface);
23446f19efc0SLukasz Majewski err_boost_unreg:
23456f19efc0SLukasz Majewski 	if (cpufreq_boost_supported())
23466f19efc0SLukasz Majewski 		cpufreq_sysfs_remove_file(&boost.attr);
23478f5bc2abSJiri Slaby err_null_driver:
23480d1857a1SNathan Zimmer 	write_lock_irqsave(&cpufreq_driver_lock, flags);
23491c3d85ddSRafael J. Wysocki 	cpufreq_driver = NULL;
23500d1857a1SNathan Zimmer 	write_unlock_irqrestore(&cpufreq_driver_lock, flags);
23514d34a67dSDave Jones 	return ret;
23521da177e4SLinus Torvalds }
23531da177e4SLinus Torvalds EXPORT_SYMBOL_GPL(cpufreq_register_driver);
23541da177e4SLinus Torvalds 
23551da177e4SLinus Torvalds /**
23561da177e4SLinus Torvalds  * cpufreq_unregister_driver - unregister the current CPUFreq driver
23571da177e4SLinus Torvalds  *
23581da177e4SLinus Torvalds  * Unregister the current CPUFreq driver. Only call this if you have
23591da177e4SLinus Torvalds  * the right to do so, i.e. if you have succeeded in initialising before!
23601da177e4SLinus Torvalds  * Returns zero if successful, and -EINVAL if the cpufreq_driver is
23611da177e4SLinus Torvalds  * currently not initialised.
23621da177e4SLinus Torvalds  */
2363221dee28SLinus Torvalds int cpufreq_unregister_driver(struct cpufreq_driver *driver)
23641da177e4SLinus Torvalds {
23651da177e4SLinus Torvalds 	unsigned long flags;
23661da177e4SLinus Torvalds 
23671c3d85ddSRafael J. Wysocki 	if (!cpufreq_driver || (driver != cpufreq_driver))
23681da177e4SLinus Torvalds 		return -EINVAL;
23691da177e4SLinus Torvalds 
23702d06d8c4SDominik Brodowski 	pr_debug("unregistering driver %s\n", driver->name);
23711da177e4SLinus Torvalds 
23728a25a2fdSKay Sievers 	subsys_interface_unregister(&cpufreq_interface);
23736f19efc0SLukasz Majewski 	if (cpufreq_boost_supported())
23746f19efc0SLukasz Majewski 		cpufreq_sysfs_remove_file(&boost.attr);
23756f19efc0SLukasz Majewski 
237665edc68cSChandra Seetharaman 	unregister_hotcpu_notifier(&cpufreq_cpu_notifier);
23771da177e4SLinus Torvalds 
23786eed9404SViresh Kumar 	down_write(&cpufreq_rwsem);
23790d1857a1SNathan Zimmer 	write_lock_irqsave(&cpufreq_driver_lock, flags);
23806eed9404SViresh Kumar 
23811c3d85ddSRafael J. Wysocki 	cpufreq_driver = NULL;
23826eed9404SViresh Kumar 
23830d1857a1SNathan Zimmer 	write_unlock_irqrestore(&cpufreq_driver_lock, flags);
23846eed9404SViresh Kumar 	up_write(&cpufreq_rwsem);
23851da177e4SLinus Torvalds 
23861da177e4SLinus Torvalds 	return 0;
23871da177e4SLinus Torvalds }
23881da177e4SLinus Torvalds EXPORT_SYMBOL_GPL(cpufreq_unregister_driver);
23895a01f2e8SVenkatesh Pallipadi 
23905a01f2e8SVenkatesh Pallipadi static int __init cpufreq_core_init(void)
23915a01f2e8SVenkatesh Pallipadi {
2392a7b422cdSKonrad Rzeszutek Wilk 	if (cpufreq_disabled())
2393a7b422cdSKonrad Rzeszutek Wilk 		return -ENODEV;
2394a7b422cdSKonrad Rzeszutek Wilk 
23952361be23SViresh Kumar 	cpufreq_global_kobject = kobject_create();
23968aa84ad8SThomas Renninger 	BUG_ON(!cpufreq_global_kobject);
23978aa84ad8SThomas Renninger 
23985a01f2e8SVenkatesh Pallipadi 	return 0;
23995a01f2e8SVenkatesh Pallipadi }
24005a01f2e8SVenkatesh Pallipadi core_initcall(cpufreq_core_init);
2401