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