blob: a235114c3d8549ff108fa1a62a1aa6874f2c125a [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
2 * drivers/cpufreq/cpufreq_ondemand.c
3 *
4 * Copyright (C) 2001 Russell King
5 * (C) 2003 Venkatesh Pallipadi <venkatesh.pallipadi@intel.com>.
6 * Jun Nakajima <jun.nakajima@intel.com>
7 *
8 * This program is free software; you can redistribute it and/or modify
9 * it under the terms of the GNU General Public License version 2 as
10 * published by the Free Software Foundation.
11 */
12
13#include <linux/kernel.h>
14#include <linux/module.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070015#include <linux/init.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070016#include <linux/cpufreq.h>
Andrew Morton138a01282006-06-23 03:31:19 -070017#include <linux/cpu.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070018#include <linux/jiffies.h>
19#include <linux/kernel_stat.h>
akpm@osdl.org3fc54d32006-01-13 15:54:22 -080020#include <linux/mutex.h>
venkatesh.pallipadi@intel.com80800912008-08-04 11:59:12 -070021#include <linux/hrtimer.h>
22#include <linux/tick.h>
23#include <linux/ktime.h>
Thomas Renninger9411b4e2009-02-04 11:54:04 +010024#include <linux/sched.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070025
26/*
27 * dbs is used in this file as a shortform for demandbased switching
28 * It helps to keep variable names smaller, simpler
29 */
30
venkatesh.pallipadi@intel.come9d95bf2008-08-04 11:59:10 -070031#define DEF_FREQUENCY_DOWN_DIFFERENTIAL (10)
Linus Torvalds1da177e2005-04-16 15:20:36 -070032#define DEF_FREQUENCY_UP_THRESHOLD (80)
venkatesh.pallipadi@intel.com80800912008-08-04 11:59:12 -070033#define MICRO_FREQUENCY_DOWN_DIFFERENTIAL (3)
34#define MICRO_FREQUENCY_UP_THRESHOLD (95)
Thomas Renningercef96152009-04-22 13:48:29 +020035#define MICRO_FREQUENCY_MIN_SAMPLE_RATE (10000)
Dave Jonesc29f1402005-05-31 19:03:50 -070036#define MIN_FREQUENCY_UP_THRESHOLD (11)
Linus Torvalds1da177e2005-04-16 15:20:36 -070037#define MAX_FREQUENCY_UP_THRESHOLD (100)
38
Dave Jones32ee8c32006-02-28 00:43:23 -050039/*
40 * The polling frequency of this governor depends on the capability of
Linus Torvalds1da177e2005-04-16 15:20:36 -070041 * the processor. Default polling frequency is 1000 times the transition
Dave Jones32ee8c32006-02-28 00:43:23 -050042 * latency of the processor. The governor will work on any processor with
43 * transition latency <= 10mS, using appropriate sampling
Linus Torvalds1da177e2005-04-16 15:20:36 -070044 * rate.
45 * For CPUs with transition latency > 10mS (mostly drivers with CPUFREQ_ETERNAL)
46 * this governor will not work.
47 * All times here are in uS.
48 */
Dave Jonesdf8b59b2005-09-20 12:39:35 -070049#define MIN_SAMPLING_RATE_RATIO (2)
Thomas Renninger112124a2009-02-04 11:55:12 +010050
Thomas Renningercef96152009-04-22 13:48:29 +020051static unsigned int min_sampling_rate;
52
Thomas Renninger112124a2009-02-04 11:55:12 +010053#define LATENCY_MULTIPLIER (1000)
Thomas Renningercef96152009-04-22 13:48:29 +020054#define MIN_LATENCY_MULTIPLIER (100)
Thomas Renninger1c256242007-10-02 13:28:12 -070055#define TRANSITION_LATENCY_LIMIT (10 * 1000 * 1000)
Linus Torvalds1da177e2005-04-16 15:20:36 -070056
David Howellsc4028952006-11-22 14:57:56 +000057static void do_dbs_timer(struct work_struct *work);
58
59/* Sampling types */
Venkatesh Pallipadi529af7a2007-02-05 16:12:44 -080060enum {DBS_NORMAL_SAMPLE, DBS_SUB_SAMPLE};
Linus Torvalds1da177e2005-04-16 15:20:36 -070061
62struct cpu_dbs_info_s {
Venkatesh Pallipadiccb2fe22006-06-28 13:49:52 -070063 cputime64_t prev_cpu_idle;
64 cputime64_t prev_cpu_wall;
venkatesh.pallipadi@intel.com80800912008-08-04 11:59:12 -070065 cputime64_t prev_cpu_nice;
Dave Jones32ee8c32006-02-28 00:43:23 -050066 struct cpufreq_policy *cur_policy;
Dave Jones2b03f892009-01-18 01:43:44 -050067 struct delayed_work work;
Alexey Starikovskiy05ca0352006-07-31 22:28:12 +040068 struct cpufreq_frequency_table *freq_table;
69 unsigned int freq_lo;
70 unsigned int freq_lo_jiffies;
71 unsigned int freq_hi_jiffies;
Venkatesh Pallipadi529af7a2007-02-05 16:12:44 -080072 int cpu;
73 unsigned int enable:1,
Dave Jones2b03f892009-01-18 01:43:44 -050074 sample_type:1;
Linus Torvalds1da177e2005-04-16 15:20:36 -070075};
76static DEFINE_PER_CPU(struct cpu_dbs_info_s, cpu_dbs_info);
77
78static unsigned int dbs_enable; /* number of CPUs using this policy */
79
Venkatesh Pallipadi4ec223d2006-06-21 15:18:34 -070080/*
81 * DEADLOCK ALERT! There is a ordering requirement between cpu_hotplug
82 * lock and dbs_mutex. cpu_hotplug lock should always be held before
83 * dbs_mutex. If any function that can potentially take cpu_hotplug lock
84 * (like __cpufreq_driver_target()) is being called with dbs_mutex taken, then
85 * cpu_hotplug lock should be taken before that. Note that cpu_hotplug lock
86 * is recursive for the same process. -Venki
Mathieu Desnoyersb14893a2009-05-17 10:30:45 -040087 * DEADLOCK ALERT! (2) : do_dbs_timer() must not take the dbs_mutex, because it
88 * would deadlock with cancel_delayed_work_sync(), which is needed for proper
89 * raceless workqueue teardown.
Venkatesh Pallipadi4ec223d2006-06-21 15:18:34 -070090 */
Venkatesh Pallipadiffac80e2006-06-28 13:52:18 -070091static DEFINE_MUTEX(dbs_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -070092
Venkatesh Pallipadi2f8a8352006-06-28 13:51:19 -070093static struct workqueue_struct *kondemand_wq;
Andi Kleen6810b542006-05-08 15:17:31 +020094
Alexey Starikovskiy05ca0352006-07-31 22:28:12 +040095static struct dbs_tuners {
Dave Jones32ee8c32006-02-28 00:43:23 -050096 unsigned int sampling_rate;
Dave Jones32ee8c32006-02-28 00:43:23 -050097 unsigned int up_threshold;
venkatesh.pallipadi@intel.come9d95bf2008-08-04 11:59:10 -070098 unsigned int down_differential;
Dave Jones32ee8c32006-02-28 00:43:23 -050099 unsigned int ignore_nice;
Alexey Starikovskiy05ca0352006-07-31 22:28:12 +0400100 unsigned int powersave_bias;
101} dbs_tuners_ins = {
Dave Jones32ee8c32006-02-28 00:43:23 -0500102 .up_threshold = DEF_FREQUENCY_UP_THRESHOLD,
venkatesh.pallipadi@intel.come9d95bf2008-08-04 11:59:10 -0700103 .down_differential = DEF_FREQUENCY_DOWN_DIFFERENTIAL,
Eric Piel9cbad612006-03-10 11:35:27 +0200104 .ignore_nice = 0,
Alexey Starikovskiy05ca0352006-07-31 22:28:12 +0400105 .powersave_bias = 0,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700106};
107
venkatesh.pallipadi@intel.com80800912008-08-04 11:59:12 -0700108static inline cputime64_t get_cpu_idle_time_jiffy(unsigned int cpu,
109 cputime64_t *wall)
Dave Jonesdac1c1a2005-05-31 19:03:49 -0700110{
Venki Pallipadiea487612007-06-20 14:26:24 -0700111 cputime64_t idle_time;
venkatesh.pallipadi@intel.com34305022008-08-04 11:59:09 -0700112 cputime64_t cur_wall_time;
Venki Pallipadiea487612007-06-20 14:26:24 -0700113 cputime64_t busy_time;
Venkatesh Pallipadiccb2fe22006-06-28 13:49:52 -0700114
venkatesh.pallipadi@intel.com34305022008-08-04 11:59:09 -0700115 cur_wall_time = jiffies64_to_cputime64(get_jiffies_64());
Venki Pallipadiea487612007-06-20 14:26:24 -0700116 busy_time = cputime64_add(kstat_cpu(cpu).cpustat.user,
117 kstat_cpu(cpu).cpustat.system);
Venkatesh Pallipadiccb2fe22006-06-28 13:49:52 -0700118
Venki Pallipadiea487612007-06-20 14:26:24 -0700119 busy_time = cputime64_add(busy_time, kstat_cpu(cpu).cpustat.irq);
120 busy_time = cputime64_add(busy_time, kstat_cpu(cpu).cpustat.softirq);
121 busy_time = cputime64_add(busy_time, kstat_cpu(cpu).cpustat.steal);
Venkatesh Pallipadi1ca3abd2009-01-23 09:25:02 -0500122 busy_time = cputime64_add(busy_time, kstat_cpu(cpu).cpustat.nice);
Venki Pallipadiea487612007-06-20 14:26:24 -0700123
venkatesh.pallipadi@intel.com34305022008-08-04 11:59:09 -0700124 idle_time = cputime64_sub(cur_wall_time, busy_time);
125 if (wall)
126 *wall = cur_wall_time;
127
Venki Pallipadiea487612007-06-20 14:26:24 -0700128 return idle_time;
Dave Jonesdac1c1a2005-05-31 19:03:49 -0700129}
130
venkatesh.pallipadi@intel.com80800912008-08-04 11:59:12 -0700131static inline cputime64_t get_cpu_idle_time(unsigned int cpu, cputime64_t *wall)
132{
133 u64 idle_time = get_cpu_idle_time_us(cpu, wall);
134
135 if (idle_time == -1ULL)
136 return get_cpu_idle_time_jiffy(cpu, wall);
137
venkatesh.pallipadi@intel.com80800912008-08-04 11:59:12 -0700138 return idle_time;
139}
140
Alexey Starikovskiy05ca0352006-07-31 22:28:12 +0400141/*
142 * Find right freq to be set now with powersave_bias on.
143 * Returns the freq_hi to be used right now and will set freq_hi_jiffies,
144 * freq_lo, and freq_lo_jiffies in percpu area for averaging freqs.
145 */
Adrian Bunkb5ecf602006-08-13 23:00:08 +0200146static unsigned int powersave_bias_target(struct cpufreq_policy *policy,
147 unsigned int freq_next,
148 unsigned int relation)
Alexey Starikovskiy05ca0352006-07-31 22:28:12 +0400149{
150 unsigned int freq_req, freq_reduc, freq_avg;
151 unsigned int freq_hi, freq_lo;
152 unsigned int index = 0;
153 unsigned int jiffies_total, jiffies_hi, jiffies_lo;
154 struct cpu_dbs_info_s *dbs_info = &per_cpu(cpu_dbs_info, policy->cpu);
155
156 if (!dbs_info->freq_table) {
157 dbs_info->freq_lo = 0;
158 dbs_info->freq_lo_jiffies = 0;
159 return freq_next;
160 }
161
162 cpufreq_frequency_table_target(policy, dbs_info->freq_table, freq_next,
163 relation, &index);
164 freq_req = dbs_info->freq_table[index].frequency;
165 freq_reduc = freq_req * dbs_tuners_ins.powersave_bias / 1000;
166 freq_avg = freq_req - freq_reduc;
167
168 /* Find freq bounds for freq_avg in freq_table */
169 index = 0;
170 cpufreq_frequency_table_target(policy, dbs_info->freq_table, freq_avg,
171 CPUFREQ_RELATION_H, &index);
172 freq_lo = dbs_info->freq_table[index].frequency;
173 index = 0;
174 cpufreq_frequency_table_target(policy, dbs_info->freq_table, freq_avg,
175 CPUFREQ_RELATION_L, &index);
176 freq_hi = dbs_info->freq_table[index].frequency;
177
178 /* Find out how long we have to be in hi and lo freqs */
179 if (freq_hi == freq_lo) {
180 dbs_info->freq_lo = 0;
181 dbs_info->freq_lo_jiffies = 0;
182 return freq_lo;
183 }
184 jiffies_total = usecs_to_jiffies(dbs_tuners_ins.sampling_rate);
185 jiffies_hi = (freq_avg - freq_lo) * jiffies_total;
186 jiffies_hi += ((freq_hi - freq_lo) / 2);
187 jiffies_hi /= (freq_hi - freq_lo);
188 jiffies_lo = jiffies_total - jiffies_hi;
189 dbs_info->freq_lo = freq_lo;
190 dbs_info->freq_lo_jiffies = jiffies_lo;
191 dbs_info->freq_hi_jiffies = jiffies_hi;
192 return freq_hi;
193}
194
195static void ondemand_powersave_bias_init(void)
196{
197 int i;
198 for_each_online_cpu(i) {
199 struct cpu_dbs_info_s *dbs_info = &per_cpu(cpu_dbs_info, i);
200 dbs_info->freq_table = cpufreq_frequency_get_table(i);
201 dbs_info->freq_lo = 0;
202 }
203}
204
Linus Torvalds1da177e2005-04-16 15:20:36 -0700205/************************** sysfs interface ************************/
206static ssize_t show_sampling_rate_max(struct cpufreq_policy *policy, char *buf)
207{
Thomas Renninger9411b4e2009-02-04 11:54:04 +0100208 static int print_once;
209
210 if (!print_once) {
211 printk(KERN_INFO "CPUFREQ: ondemand sampling_rate_max "
212 "sysfs file is deprecated - used by: %s\n",
213 current->comm);
214 print_once = 1;
215 }
Thomas Renningercef96152009-04-22 13:48:29 +0200216 return sprintf(buf, "%u\n", -1U);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700217}
218
219static ssize_t show_sampling_rate_min(struct cpufreq_policy *policy, char *buf)
220{
Thomas Renninger9411b4e2009-02-04 11:54:04 +0100221 static int print_once;
222
223 if (!print_once) {
224 printk(KERN_INFO "CPUFREQ: ondemand sampling_rate_min "
225 "sysfs file is deprecated - used by: %s\n",
226 current->comm);
227 print_once = 1;
228 }
Thomas Renningercef96152009-04-22 13:48:29 +0200229 return sprintf(buf, "%u\n", min_sampling_rate);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700230}
231
Dave Jones32ee8c32006-02-28 00:43:23 -0500232#define define_one_ro(_name) \
233static struct freq_attr _name = \
Linus Torvalds1da177e2005-04-16 15:20:36 -0700234__ATTR(_name, 0444, show_##_name, NULL)
235
236define_one_ro(sampling_rate_max);
237define_one_ro(sampling_rate_min);
238
239/* cpufreq_ondemand Governor Tunables */
240#define show_one(file_name, object) \
241static ssize_t show_##file_name \
242(struct cpufreq_policy *unused, char *buf) \
243{ \
244 return sprintf(buf, "%u\n", dbs_tuners_ins.object); \
245}
246show_one(sampling_rate, sampling_rate);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700247show_one(up_threshold, up_threshold);
Alexander Clouter001893c2005-12-01 01:09:25 -0800248show_one(ignore_nice_load, ignore_nice);
Alexey Starikovskiy05ca0352006-07-31 22:28:12 +0400249show_one(powersave_bias, powersave_bias);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700250
Dave Jones32ee8c32006-02-28 00:43:23 -0500251static ssize_t store_sampling_rate(struct cpufreq_policy *unused,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700252 const char *buf, size_t count)
253{
254 unsigned int input;
255 int ret;
Venkatesh Pallipadiffac80e2006-06-28 13:52:18 -0700256 ret = sscanf(buf, "%u", &input);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700257
akpm@osdl.org3fc54d32006-01-13 15:54:22 -0800258 mutex_lock(&dbs_mutex);
Thomas Renninger112124a2009-02-04 11:55:12 +0100259 if (ret != 1) {
akpm@osdl.org3fc54d32006-01-13 15:54:22 -0800260 mutex_unlock(&dbs_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700261 return -EINVAL;
262 }
Thomas Renningercef96152009-04-22 13:48:29 +0200263 dbs_tuners_ins.sampling_rate = max(input, min_sampling_rate);
akpm@osdl.org3fc54d32006-01-13 15:54:22 -0800264 mutex_unlock(&dbs_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700265
266 return count;
267}
268
Dave Jones32ee8c32006-02-28 00:43:23 -0500269static ssize_t store_up_threshold(struct cpufreq_policy *unused,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700270 const char *buf, size_t count)
271{
272 unsigned int input;
273 int ret;
Venkatesh Pallipadiffac80e2006-06-28 13:52:18 -0700274 ret = sscanf(buf, "%u", &input);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700275
akpm@osdl.org3fc54d32006-01-13 15:54:22 -0800276 mutex_lock(&dbs_mutex);
Dave Jones32ee8c32006-02-28 00:43:23 -0500277 if (ret != 1 || input > MAX_FREQUENCY_UP_THRESHOLD ||
Dave Jonesc29f1402005-05-31 19:03:50 -0700278 input < MIN_FREQUENCY_UP_THRESHOLD) {
akpm@osdl.org3fc54d32006-01-13 15:54:22 -0800279 mutex_unlock(&dbs_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700280 return -EINVAL;
281 }
282
283 dbs_tuners_ins.up_threshold = input;
akpm@osdl.org3fc54d32006-01-13 15:54:22 -0800284 mutex_unlock(&dbs_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700285
286 return count;
287}
288
Alexander Clouter001893c2005-12-01 01:09:25 -0800289static ssize_t store_ignore_nice_load(struct cpufreq_policy *policy,
Dave Jones3d5ee9e2005-05-31 19:03:47 -0700290 const char *buf, size_t count)
291{
292 unsigned int input;
293 int ret;
294
295 unsigned int j;
Dave Jones32ee8c32006-02-28 00:43:23 -0500296
Venkatesh Pallipadiffac80e2006-06-28 13:52:18 -0700297 ret = sscanf(buf, "%u", &input);
Dave Jones2b03f892009-01-18 01:43:44 -0500298 if (ret != 1)
Dave Jones3d5ee9e2005-05-31 19:03:47 -0700299 return -EINVAL;
300
Dave Jones2b03f892009-01-18 01:43:44 -0500301 if (input > 1)
Dave Jones3d5ee9e2005-05-31 19:03:47 -0700302 input = 1;
Dave Jones32ee8c32006-02-28 00:43:23 -0500303
akpm@osdl.org3fc54d32006-01-13 15:54:22 -0800304 mutex_lock(&dbs_mutex);
Dave Jones2b03f892009-01-18 01:43:44 -0500305 if (input == dbs_tuners_ins.ignore_nice) { /* nothing to do */
akpm@osdl.org3fc54d32006-01-13 15:54:22 -0800306 mutex_unlock(&dbs_mutex);
Dave Jones3d5ee9e2005-05-31 19:03:47 -0700307 return count;
308 }
309 dbs_tuners_ins.ignore_nice = input;
310
Venkatesh Pallipadiccb2fe22006-06-28 13:49:52 -0700311 /* we need to re-evaluate prev_cpu_idle */
Dave Jonesdac1c1a2005-05-31 19:03:49 -0700312 for_each_online_cpu(j) {
Venkatesh Pallipadiccb2fe22006-06-28 13:49:52 -0700313 struct cpu_dbs_info_s *dbs_info;
314 dbs_info = &per_cpu(cpu_dbs_info, j);
venkatesh.pallipadi@intel.com34305022008-08-04 11:59:09 -0700315 dbs_info->prev_cpu_idle = get_cpu_idle_time(j,
316 &dbs_info->prev_cpu_wall);
Venkatesh Pallipadi1ca3abd2009-01-23 09:25:02 -0500317 if (dbs_tuners_ins.ignore_nice)
318 dbs_info->prev_cpu_nice = kstat_cpu(j).cpustat.nice;
319
Dave Jones3d5ee9e2005-05-31 19:03:47 -0700320 }
akpm@osdl.org3fc54d32006-01-13 15:54:22 -0800321 mutex_unlock(&dbs_mutex);
Dave Jones3d5ee9e2005-05-31 19:03:47 -0700322
323 return count;
324}
325
Alexey Starikovskiy05ca0352006-07-31 22:28:12 +0400326static ssize_t store_powersave_bias(struct cpufreq_policy *unused,
327 const char *buf, size_t count)
328{
329 unsigned int input;
330 int ret;
331 ret = sscanf(buf, "%u", &input);
332
333 if (ret != 1)
334 return -EINVAL;
335
336 if (input > 1000)
337 input = 1000;
338
339 mutex_lock(&dbs_mutex);
340 dbs_tuners_ins.powersave_bias = input;
341 ondemand_powersave_bias_init();
342 mutex_unlock(&dbs_mutex);
343
344 return count;
345}
346
Linus Torvalds1da177e2005-04-16 15:20:36 -0700347#define define_one_rw(_name) \
348static struct freq_attr _name = \
349__ATTR(_name, 0644, show_##_name, store_##_name)
350
351define_one_rw(sampling_rate);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700352define_one_rw(up_threshold);
Alexander Clouter001893c2005-12-01 01:09:25 -0800353define_one_rw(ignore_nice_load);
Alexey Starikovskiy05ca0352006-07-31 22:28:12 +0400354define_one_rw(powersave_bias);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700355
Dave Jones2b03f892009-01-18 01:43:44 -0500356static struct attribute *dbs_attributes[] = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700357 &sampling_rate_max.attr,
358 &sampling_rate_min.attr,
359 &sampling_rate.attr,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700360 &up_threshold.attr,
Alexander Clouter001893c2005-12-01 01:09:25 -0800361 &ignore_nice_load.attr,
Alexey Starikovskiy05ca0352006-07-31 22:28:12 +0400362 &powersave_bias.attr,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700363 NULL
364};
365
366static struct attribute_group dbs_attr_group = {
367 .attrs = dbs_attributes,
368 .name = "ondemand",
369};
370
371/************************** sysfs end ************************/
372
Venkatesh Pallipadi2f8a8352006-06-28 13:51:19 -0700373static void dbs_check_cpu(struct cpu_dbs_info_s *this_dbs_info)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700374{
venkatesh.pallipadi@intel.comc43aa3b2008-08-04 11:59:08 -0700375 unsigned int max_load_freq;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700376
377 struct cpufreq_policy *policy;
378 unsigned int j;
379
Linus Torvalds1da177e2005-04-16 15:20:36 -0700380 if (!this_dbs_info->enable)
381 return;
382
Alexey Starikovskiy05ca0352006-07-31 22:28:12 +0400383 this_dbs_info->freq_lo = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700384 policy = this_dbs_info->cur_policy;
Venki Pallipadiea487612007-06-20 14:26:24 -0700385
Dave Jones32ee8c32006-02-28 00:43:23 -0500386 /*
Dave Jonesc29f1402005-05-31 19:03:50 -0700387 * Every sampling_rate, we check, if current idle time is less
388 * than 20% (default), then we try to increase frequency
Venkatesh Pallipadiccb2fe22006-06-28 13:49:52 -0700389 * Every sampling_rate, we look for a the lowest
Dave Jonesc29f1402005-05-31 19:03:50 -0700390 * frequency which can sustain the load while keeping idle time over
391 * 30%. If such a frequency exist, we try to decrease to this frequency.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700392 *
Dave Jones32ee8c32006-02-28 00:43:23 -0500393 * Any frequency increase takes it to the maximum frequency.
394 * Frequency reduction happens at minimum steps of
395 * 5% (default) of current frequency
Linus Torvalds1da177e2005-04-16 15:20:36 -0700396 */
397
venkatesh.pallipadi@intel.comc43aa3b2008-08-04 11:59:08 -0700398 /* Get Absolute Load - in terms of freq */
399 max_load_freq = 0;
400
Rusty Russell835481d2009-01-04 05:18:06 -0800401 for_each_cpu(j, policy->cpus) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700402 struct cpu_dbs_info_s *j_dbs_info;
venkatesh.pallipadi@intel.comc43aa3b2008-08-04 11:59:08 -0700403 cputime64_t cur_wall_time, cur_idle_time;
404 unsigned int idle_time, wall_time;
405 unsigned int load, load_freq;
406 int freq_avg;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700407
Linus Torvalds1da177e2005-04-16 15:20:36 -0700408 j_dbs_info = &per_cpu(cpu_dbs_info, j);
venkatesh.pallipadi@intel.com34305022008-08-04 11:59:09 -0700409
410 cur_idle_time = get_cpu_idle_time(j, &cur_wall_time);
411
venkatesh.pallipadi@intel.comc43aa3b2008-08-04 11:59:08 -0700412 wall_time = (unsigned int) cputime64_sub(cur_wall_time,
413 j_dbs_info->prev_cpu_wall);
414 j_dbs_info->prev_cpu_wall = cur_wall_time;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700415
venkatesh.pallipadi@intel.comc43aa3b2008-08-04 11:59:08 -0700416 idle_time = (unsigned int) cputime64_sub(cur_idle_time,
417 j_dbs_info->prev_cpu_idle);
418 j_dbs_info->prev_cpu_idle = cur_idle_time;
419
Venkatesh Pallipadi1ca3abd2009-01-23 09:25:02 -0500420 if (dbs_tuners_ins.ignore_nice) {
421 cputime64_t cur_nice;
422 unsigned long cur_nice_jiffies;
423
424 cur_nice = cputime64_sub(kstat_cpu(j).cpustat.nice,
425 j_dbs_info->prev_cpu_nice);
426 /*
427 * Assumption: nice time between sampling periods will
428 * be less than 2^32 jiffies for 32 bit sys
429 */
430 cur_nice_jiffies = (unsigned long)
431 cputime64_to_jiffies64(cur_nice);
432
433 j_dbs_info->prev_cpu_nice = kstat_cpu(j).cpustat.nice;
434 idle_time += jiffies_to_usecs(cur_nice_jiffies);
435 }
436
venkatesh.pallipadi@intel.com34305022008-08-04 11:59:09 -0700437 if (unlikely(!wall_time || wall_time < idle_time))
venkatesh.pallipadi@intel.comc43aa3b2008-08-04 11:59:08 -0700438 continue;
venkatesh.pallipadi@intel.comc43aa3b2008-08-04 11:59:08 -0700439
440 load = 100 * (wall_time - idle_time) / wall_time;
441
442 freq_avg = __cpufreq_driver_getavg(policy, j);
443 if (freq_avg <= 0)
444 freq_avg = policy->cur;
445
446 load_freq = load * freq_avg;
447 if (load_freq > max_load_freq)
448 max_load_freq = load_freq;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700449 }
450
Venkatesh Pallipadiccb2fe22006-06-28 13:49:52 -0700451 /* Check for frequency increase */
venkatesh.pallipadi@intel.comc43aa3b2008-08-04 11:59:08 -0700452 if (max_load_freq > dbs_tuners_ins.up_threshold * policy->cur) {
Dave Jonesc11420a2005-05-31 19:03:48 -0700453 /* if we are already at full speed then break out early */
Alexey Starikovskiy05ca0352006-07-31 22:28:12 +0400454 if (!dbs_tuners_ins.powersave_bias) {
455 if (policy->cur == policy->max)
456 return;
Dave Jones32ee8c32006-02-28 00:43:23 -0500457
Alexey Starikovskiy05ca0352006-07-31 22:28:12 +0400458 __cpufreq_driver_target(policy, policy->max,
459 CPUFREQ_RELATION_H);
460 } else {
461 int freq = powersave_bias_target(policy, policy->max,
462 CPUFREQ_RELATION_H);
463 __cpufreq_driver_target(policy, freq,
464 CPUFREQ_RELATION_L);
465 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700466 return;
467 }
468
469 /* Check for frequency decrease */
Dave Jonesc29f1402005-05-31 19:03:50 -0700470 /* if we cannot reduce the frequency anymore, break out early */
471 if (policy->cur == policy->min)
472 return;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700473
Dave Jonesc29f1402005-05-31 19:03:50 -0700474 /*
475 * The optimal frequency is the frequency that is the lowest that
476 * can support the current CPU usage without triggering the up
477 * policy. To be safe, we focus 10 points under the threshold.
478 */
venkatesh.pallipadi@intel.come9d95bf2008-08-04 11:59:10 -0700479 if (max_load_freq <
480 (dbs_tuners_ins.up_threshold - dbs_tuners_ins.down_differential) *
481 policy->cur) {
venkatesh.pallipadi@intel.comc43aa3b2008-08-04 11:59:08 -0700482 unsigned int freq_next;
venkatesh.pallipadi@intel.come9d95bf2008-08-04 11:59:10 -0700483 freq_next = max_load_freq /
484 (dbs_tuners_ins.up_threshold -
485 dbs_tuners_ins.down_differential);
Venkatesh Pallipadidfde5d62006-10-03 12:38:45 -0700486
Alexey Starikovskiy05ca0352006-07-31 22:28:12 +0400487 if (!dbs_tuners_ins.powersave_bias) {
488 __cpufreq_driver_target(policy, freq_next,
489 CPUFREQ_RELATION_L);
490 } else {
491 int freq = powersave_bias_target(policy, freq_next,
492 CPUFREQ_RELATION_L);
493 __cpufreq_driver_target(policy, freq,
494 CPUFREQ_RELATION_L);
495 }
Venkatesh Pallipadiccb2fe22006-06-28 13:49:52 -0700496 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700497}
498
David Howellsc4028952006-11-22 14:57:56 +0000499static void do_dbs_timer(struct work_struct *work)
Dave Jones32ee8c32006-02-28 00:43:23 -0500500{
Venkatesh Pallipadi529af7a2007-02-05 16:12:44 -0800501 struct cpu_dbs_info_s *dbs_info =
502 container_of(work, struct cpu_dbs_info_s, work.work);
503 unsigned int cpu = dbs_info->cpu;
504 int sample_type = dbs_info->sample_type;
505
Alexey Starikovskiy1ce28d62006-07-31 22:25:20 +0400506 /* We want all CPUs to do sampling nearly on same jiffy */
507 int delay = usecs_to_jiffies(dbs_tuners_ins.sampling_rate);
David Howellsc4028952006-11-22 14:57:56 +0000508
Alexey Starikovskiy1ce28d62006-07-31 22:25:20 +0400509 delay -= jiffies % delay;
Venkatesh Pallipadi2f8a8352006-06-28 13:51:19 -0700510
Venkatesh Pallipadi56463b72007-02-05 16:12:45 -0800511 if (lock_policy_rwsem_write(cpu) < 0)
Linus Torvalds2cd7cbd2006-07-23 12:05:00 -0700512 return;
Venkatesh Pallipadi56463b72007-02-05 16:12:45 -0800513
514 if (!dbs_info->enable) {
515 unlock_policy_rwsem_write(cpu);
516 return;
517 }
518
Alexey Starikovskiy05ca0352006-07-31 22:28:12 +0400519 /* Common NORMAL_SAMPLE setup */
David Howellsc4028952006-11-22 14:57:56 +0000520 dbs_info->sample_type = DBS_NORMAL_SAMPLE;
Alexey Starikovskiy05ca0352006-07-31 22:28:12 +0400521 if (!dbs_tuners_ins.powersave_bias ||
David Howellsc4028952006-11-22 14:57:56 +0000522 sample_type == DBS_NORMAL_SAMPLE) {
Alexey Starikovskiy05ca0352006-07-31 22:28:12 +0400523 dbs_check_cpu(dbs_info);
Alexey Starikovskiy05ca0352006-07-31 22:28:12 +0400524 if (dbs_info->freq_lo) {
525 /* Setup timer for SUB_SAMPLE */
David Howellsc4028952006-11-22 14:57:56 +0000526 dbs_info->sample_type = DBS_SUB_SAMPLE;
Alexey Starikovskiy05ca0352006-07-31 22:28:12 +0400527 delay = dbs_info->freq_hi_jiffies;
528 }
529 } else {
530 __cpufreq_driver_target(dbs_info->cur_policy,
Dave Jones2b03f892009-01-18 01:43:44 -0500531 dbs_info->freq_lo, CPUFREQ_RELATION_H);
Alexey Starikovskiy05ca0352006-07-31 22:28:12 +0400532 }
Alexey Starikovskiy1ce28d62006-07-31 22:25:20 +0400533 queue_delayed_work_on(cpu, kondemand_wq, &dbs_info->work, delay);
Venkatesh Pallipadi56463b72007-02-05 16:12:45 -0800534 unlock_policy_rwsem_write(cpu);
Dave Jones32ee8c32006-02-28 00:43:23 -0500535}
Linus Torvalds1da177e2005-04-16 15:20:36 -0700536
Venkatesh Pallipadi529af7a2007-02-05 16:12:44 -0800537static inline void dbs_timer_init(struct cpu_dbs_info_s *dbs_info)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700538{
Alexey Starikovskiy1ce28d62006-07-31 22:25:20 +0400539 /* We want all CPUs to do sampling nearly on same jiffy */
540 int delay = usecs_to_jiffies(dbs_tuners_ins.sampling_rate);
541 delay -= jiffies % delay;
Venkatesh Pallipadi2f8a8352006-06-28 13:51:19 -0700542
Dave Jonesc18a1482007-02-10 20:03:51 -0500543 dbs_info->enable = 1;
Alexey Starikovskiy05ca0352006-07-31 22:28:12 +0400544 ondemand_powersave_bias_init();
David Howellsc4028952006-11-22 14:57:56 +0000545 dbs_info->sample_type = DBS_NORMAL_SAMPLE;
Venki Pallipadi28287032007-05-08 00:27:47 -0700546 INIT_DELAYED_WORK_DEFERRABLE(&dbs_info->work, do_dbs_timer);
Venkatesh Pallipadi529af7a2007-02-05 16:12:44 -0800547 queue_delayed_work_on(dbs_info->cpu, kondemand_wq, &dbs_info->work,
Dave Jones2b03f892009-01-18 01:43:44 -0500548 delay);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700549}
550
Linus Torvalds2cd7cbd2006-07-23 12:05:00 -0700551static inline void dbs_timer_exit(struct cpu_dbs_info_s *dbs_info)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700552{
Linus Torvalds2cd7cbd2006-07-23 12:05:00 -0700553 dbs_info->enable = 0;
Mathieu Desnoyersb14893a2009-05-17 10:30:45 -0400554 cancel_delayed_work_sync(&dbs_info->work);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700555}
556
557static int cpufreq_governor_dbs(struct cpufreq_policy *policy,
558 unsigned int event)
559{
560 unsigned int cpu = policy->cpu;
561 struct cpu_dbs_info_s *this_dbs_info;
562 unsigned int j;
Jeff Garzik914f7c32006-10-20 14:31:00 -0700563 int rc;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700564
565 this_dbs_info = &per_cpu(cpu_dbs_info, cpu);
566
567 switch (event) {
568 case CPUFREQ_GOV_START:
Venkatesh Pallipadiffac80e2006-06-28 13:52:18 -0700569 if ((!cpu_online(cpu)) || (!policy->cur))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700570 return -EINVAL;
571
Linus Torvalds1da177e2005-04-16 15:20:36 -0700572 if (this_dbs_info->enable) /* Already enabled */
573 break;
Dave Jones32ee8c32006-02-28 00:43:23 -0500574
akpm@osdl.org3fc54d32006-01-13 15:54:22 -0800575 mutex_lock(&dbs_mutex);
Venkatesh Pallipadi2f8a8352006-06-28 13:51:19 -0700576 dbs_enable++;
Jeff Garzik914f7c32006-10-20 14:31:00 -0700577
578 rc = sysfs_create_group(&policy->kobj, &dbs_attr_group);
579 if (rc) {
Jeff Garzik914f7c32006-10-20 14:31:00 -0700580 dbs_enable--;
581 mutex_unlock(&dbs_mutex);
582 return rc;
583 }
584
Rusty Russell835481d2009-01-04 05:18:06 -0800585 for_each_cpu(j, policy->cpus) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700586 struct cpu_dbs_info_s *j_dbs_info;
587 j_dbs_info = &per_cpu(cpu_dbs_info, j);
588 j_dbs_info->cur_policy = policy;
Dave Jones32ee8c32006-02-28 00:43:23 -0500589
venkatesh.pallipadi@intel.com34305022008-08-04 11:59:09 -0700590 j_dbs_info->prev_cpu_idle = get_cpu_idle_time(j,
591 &j_dbs_info->prev_cpu_wall);
Venkatesh Pallipadi1ca3abd2009-01-23 09:25:02 -0500592 if (dbs_tuners_ins.ignore_nice) {
593 j_dbs_info->prev_cpu_nice =
594 kstat_cpu(j).cpustat.nice;
595 }
Linus Torvalds1da177e2005-04-16 15:20:36 -0700596 }
Venkatesh Pallipadi529af7a2007-02-05 16:12:44 -0800597 this_dbs_info->cpu = cpu;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700598 /*
599 * Start the timerschedule work, when this governor
600 * is used for first time
601 */
602 if (dbs_enable == 1) {
603 unsigned int latency;
604 /* policy latency is in nS. Convert it to uS first */
Dave Jonesdf8b59b2005-09-20 12:39:35 -0700605 latency = policy->cpuinfo.transition_latency / 1000;
606 if (latency == 0)
607 latency = 1;
Thomas Renningercef96152009-04-22 13:48:29 +0200608 /* Bring kernel and HW constraints together */
609 min_sampling_rate = max(min_sampling_rate,
610 MIN_LATENCY_MULTIPLIER * latency);
611 dbs_tuners_ins.sampling_rate =
612 max(min_sampling_rate,
613 latency * LATENCY_MULTIPLIER);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700614 }
Venkatesh Pallipadi529af7a2007-02-05 16:12:44 -0800615 dbs_timer_init(this_dbs_info);
Dave Jones32ee8c32006-02-28 00:43:23 -0500616
akpm@osdl.org3fc54d32006-01-13 15:54:22 -0800617 mutex_unlock(&dbs_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700618 break;
619
620 case CPUFREQ_GOV_STOP:
akpm@osdl.org3fc54d32006-01-13 15:54:22 -0800621 mutex_lock(&dbs_mutex);
Linus Torvalds2cd7cbd2006-07-23 12:05:00 -0700622 dbs_timer_exit(this_dbs_info);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700623 sysfs_remove_group(&policy->kobj, &dbs_attr_group);
624 dbs_enable--;
akpm@osdl.org3fc54d32006-01-13 15:54:22 -0800625 mutex_unlock(&dbs_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700626
627 break;
628
629 case CPUFREQ_GOV_LIMITS:
akpm@osdl.org3fc54d32006-01-13 15:54:22 -0800630 mutex_lock(&dbs_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700631 if (policy->max < this_dbs_info->cur_policy->cur)
Venkatesh Pallipadiffac80e2006-06-28 13:52:18 -0700632 __cpufreq_driver_target(this_dbs_info->cur_policy,
Dave Jones2b03f892009-01-18 01:43:44 -0500633 policy->max, CPUFREQ_RELATION_H);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700634 else if (policy->min > this_dbs_info->cur_policy->cur)
Venkatesh Pallipadiffac80e2006-06-28 13:52:18 -0700635 __cpufreq_driver_target(this_dbs_info->cur_policy,
Dave Jones2b03f892009-01-18 01:43:44 -0500636 policy->min, CPUFREQ_RELATION_L);
akpm@osdl.org3fc54d32006-01-13 15:54:22 -0800637 mutex_unlock(&dbs_mutex);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700638 break;
639 }
640 return 0;
641}
642
Sven Wegenerc4d14bc2008-09-20 16:50:08 +0200643#ifndef CONFIG_CPU_FREQ_DEFAULT_GOV_ONDEMAND
644static
645#endif
Thomas Renninger1c256242007-10-02 13:28:12 -0700646struct cpufreq_governor cpufreq_gov_ondemand = {
647 .name = "ondemand",
648 .governor = cpufreq_governor_dbs,
649 .max_transition_latency = TRANSITION_LATENCY_LIMIT,
650 .owner = THIS_MODULE,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700651};
Linus Torvalds1da177e2005-04-16 15:20:36 -0700652
653static int __init cpufreq_gov_dbs_init(void)
654{
Akinobu Mita888a7942008-07-14 12:00:45 +0900655 int err;
venkatesh.pallipadi@intel.com80800912008-08-04 11:59:12 -0700656 cputime64_t wall;
Andrea Righi4f6e6b92008-09-18 10:43:40 +0000657 u64 idle_time;
658 int cpu = get_cpu();
venkatesh.pallipadi@intel.com80800912008-08-04 11:59:12 -0700659
Andrea Righi4f6e6b92008-09-18 10:43:40 +0000660 idle_time = get_cpu_idle_time_us(cpu, &wall);
661 put_cpu();
venkatesh.pallipadi@intel.com80800912008-08-04 11:59:12 -0700662 if (idle_time != -1ULL) {
663 /* Idle micro accounting is supported. Use finer thresholds */
664 dbs_tuners_ins.up_threshold = MICRO_FREQUENCY_UP_THRESHOLD;
665 dbs_tuners_ins.down_differential =
666 MICRO_FREQUENCY_DOWN_DIFFERENTIAL;
Thomas Renningercef96152009-04-22 13:48:29 +0200667 /*
668 * In no_hz/micro accounting case we set the minimum frequency
669 * not depending on HZ, but fixed (very low). The deferred
670 * timer might skip some samples if idle/sleeping as needed.
671 */
672 min_sampling_rate = MICRO_FREQUENCY_MIN_SAMPLE_RATE;
673 } else {
674 /* For correct statistics, we need 10 ticks for each measure */
675 min_sampling_rate =
676 MIN_SAMPLING_RATE_RATIO * jiffies_to_usecs(10);
venkatesh.pallipadi@intel.com80800912008-08-04 11:59:12 -0700677 }
Akinobu Mita888a7942008-07-14 12:00:45 +0900678
Venkatesh Pallipadi56463b72007-02-05 16:12:45 -0800679 kondemand_wq = create_workqueue("kondemand");
680 if (!kondemand_wq) {
681 printk(KERN_ERR "Creation of kondemand failed\n");
682 return -EFAULT;
683 }
Akinobu Mita888a7942008-07-14 12:00:45 +0900684 err = cpufreq_register_governor(&cpufreq_gov_ondemand);
685 if (err)
686 destroy_workqueue(kondemand_wq);
687
688 return err;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700689}
690
691static void __exit cpufreq_gov_dbs_exit(void)
692{
Thomas Renninger1c256242007-10-02 13:28:12 -0700693 cpufreq_unregister_governor(&cpufreq_gov_ondemand);
Venkatesh Pallipadi56463b72007-02-05 16:12:45 -0800694 destroy_workqueue(kondemand_wq);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700695}
696
697
Venkatesh Pallipadiffac80e2006-06-28 13:52:18 -0700698MODULE_AUTHOR("Venkatesh Pallipadi <venkatesh.pallipadi@intel.com>");
699MODULE_AUTHOR("Alexey Starikovskiy <alexey.y.starikovskiy@intel.com>");
700MODULE_DESCRIPTION("'cpufreq_ondemand' - A dynamic cpufreq governor for "
Dave Jones2b03f892009-01-18 01:43:44 -0500701 "Low Latency Frequency Transition capable processors");
Venkatesh Pallipadiffac80e2006-06-28 13:52:18 -0700702MODULE_LICENSE("GPL");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700703
Johannes Weiner69157192008-01-17 15:21:08 -0800704#ifdef CONFIG_CPU_FREQ_DEFAULT_GOV_ONDEMAND
705fs_initcall(cpufreq_gov_dbs_init);
706#else
Linus Torvalds1da177e2005-04-16 15:20:36 -0700707module_init(cpufreq_gov_dbs_init);
Johannes Weiner69157192008-01-17 15:21:08 -0800708#endif
Linus Torvalds1da177e2005-04-16 15:20:36 -0700709module_exit(cpufreq_gov_dbs_exit);