Annotation of prex/dev/power/cpufreq.c, Revision 1.1.1.1
1.1 nbrk 1: /*-
2: * Copyright (c) 2007-2008, Kohsuke Ohtani
3: * All rights reserved.
4: *
5: * Redistribution and use in source and binary forms, with or without
6: * modification, are permitted provided that the following conditions
7: * are met:
8: * 1. Redistributions of source code must retain the above copyright
9: * notice, this list of conditions and the following disclaimer.
10: * 2. Redistributions in binary form must reproduce the above copyright
11: * notice, this list of conditions and the following disclaimer in the
12: * documentation and/or other materials provided with the distribution.
13: * 3. Neither the name of the author nor the names of any co-contributors
14: * may be used to endorse or promote products derived from this software
15: * without specific prior written permission.
16: *
17: * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
18: * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19: * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20: * ARE DISCLAIMED. IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
21: * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
22: * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
23: * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
24: * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
25: * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
26: * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27: * SUCH DAMAGE.
28: */
29:
30: /*
31: * cpufreq.c - CPU frequency control
32: */
33:
34: /*
35: * Dynamic voltage scaling (DVS)
36: *
37: * DVS is widely used with mobile systems to save the processor
38: * power consumption, with minimum impact on performance.
39: * The basic idea is come from the fact the power consumption is
40: * proportional to V^2 x f, where V is voltage and f is frequency.
41: * Since processor does not always require the full performance,
42: * we can reduce power consumption by lowering voltage and frequeceny.
43: */
44:
45: #include <sys/ioctl.h>
46: #include <driver.h>
47: #include <pm.h>
48: #include <cpu.h>
49: #include <cpufreq.h>
50:
51: /* #define DEBUG_CPUFREQ 1 */
52:
53: #ifdef DEBUG_CPUFREQ
54: #define DPRINTF(a) printf a
55: #else
56: #define DPRINTF(a)
57: #endif
58:
59: /*
60: * DVS parameters
61: */
62: #define INTERVAL_MSEC 50
63: #define INTERVAL_TICK msec_to_tick(INTERVAL_MSEC)
64: #define WEIGHT 20
65:
66: static int cpufreq_open(device_t dev, int mode);
67: static int cpufreq_ioctl(device_t dev, u_long cmd, void *arg);
68: static int cpufreq_close(device_t dev);
69: static int cpufreq_init(void);
70:
71: /*
72: * Driver structure
73: */
74: struct driver cpufreq_drv = {
75: /* name */ "CPU Frequency Control",
76: /* order */ 3, /* Must larger than pm driver */
77: /* init */ cpufreq_init,
78: };
79:
80: /*
81: * Device I/O table
82: */
83: static struct devio cpufreq_io = {
84: /* open */ cpufreq_open,
85: /* close */ cpufreq_close,
86: /* read */ NULL,
87: /* write */ NULL,
88: /* ioctl */ cpufreq_ioctl,
89: /* event */ NULL,
90: };
91:
92: static device_t cpufreq_dev; /* Device object */
93:
94: static int cpufreq_policy; /* Frequecy control policy */
95:
96: static struct dpc dvs_dpc; /* DPC object */
97:
98: static int dvs_capable; /* True if the system has dvs capability */
99: static int dvs_enabled; /* True if dvs is enabled */
100:
101: static int cur_speed; /* Current CPU speed (%) */
102: static int max_speed; /* Maximum CPU speed (%) */
103: static int min_speed; /* Minimum CPU speed (%) */
104:
105: static int run_cycles; /* The non-idle CPU cycles in the last interval */
106: static int idle_cycles; /* The idle CPU cycles in the last interval */
107: static int excess_cycles; /* The cycles left over from the last interval */
108:
109: static int avg_workload; /* Average workload */
110: static int avg_deadline; /* Average deadline */
111:
112: static u_long elapsed_ticks;
113:
114:
115: /*
116: * Predict CPU speed.
117: *
118: * DVS Algorithm: Weiser Style
119: *
120: * If the utilization prediction x is high (over 70%), increase the
121: * speed by 20% of the maximum speed. If the utilization prediction
122: * is low (under 50%), decrease the speed by (60 - x)% of the
123: * maximum speed.
124: *
125: * excess_cycles is defined as the number of uncompleted run cycles
126: * from the last interval. For example, if we find 70% activity
127: * when runnig at full speed, and their processor speed was set to
128: * 50% during that interval, excess_cycles is set to 20%. This
129: * value (20%) is used to calculate the processor speed in the next
130: * interval.
131: *
132: * Refernce:
133: * M.Weiser, B.Welch, A.Demers, and S.Shenker,
134: * "Scheduling for Reduced CPU Energy", In Proceedings of the
135: * 1st Symposium on Operating Systems Design and Implementation,
136: * pages 13-23, November 1994.
137: */
138: static int
139: predict_cpu_speed(int speed)
140: {
141: int next_excess;
142: int run_percent;
143: int newspeed = speed;
144:
145: run_cycles += excess_cycles;
146: run_percent = (run_cycles * 100) / (idle_cycles + run_cycles);
147:
148: next_excess = run_cycles - speed * (run_cycles + idle_cycles) / 100;
149: if (next_excess < 0)
150: next_excess = 0;
151:
152: if (excess_cycles > idle_cycles)
153: newspeed = 100;
154: else if (run_percent > 70)
155: newspeed = speed + 20;
156: else if (run_percent < 50)
157: newspeed = speed - (60 - run_percent);
158:
159: if (newspeed > max_speed)
160: newspeed = max_speed;
161: if (newspeed < min_speed)
162: newspeed = min_speed;
163:
164: DPRINTF(("DVS: run_percent=%d next_excess=%d newspeed=%d\n\n",
165: run_percent, next_excess, newspeed));
166:
167: excess_cycles = next_excess;
168: return newspeed;
169: }
170:
171: /*
172: * Predict max CPU speed.
173: *
174: * DVS Algorithm: AVG<3>
175: *
176: * Computes an exponentially moving average of the previous intervals.
177: * <wight> is the relative weighting of past intervals relative to
178: * the current interval.
179: *
180: * predict = (weight x current + past) / (weight + 1)
181: *
182: * Refernce:
183: * K.Govil, E.Chan, H.Wasserman,
184: * "Comparing Algorithm for Dynamic Speed-Setting of a Low-Power CPU".
185: * Proc. 1st Int'l Conference on Mobile Computing and Networking,
186: * Nov 1995.
187: */
188: static int
189: predict_max_speed(int speed)
190: {
191: int new_workload;
192: int new_deadline;
193: int newspeed;
194:
195: new_workload = run_cycles * speed;
196: new_deadline = (run_cycles + idle_cycles) * speed;
197:
198: avg_workload = (avg_workload * WEIGHT + new_workload) / (WEIGHT + 1);
199: avg_deadline = (avg_deadline * WEIGHT + new_deadline) / (WEIGHT + 1);
200:
201: newspeed = avg_workload * 100 / avg_deadline;
202:
203: DPRINTF(("DVS: new_workload=%u new_deadline=%u\n",
204: new_workload, new_deadline));
205: DPRINTF(("DVS: avg_workload=%u avg_deadline=%u\n",
206: avg_workload, avg_deadline));
207: return newspeed;
208: }
209:
210: /*
211: * DPC routine to set CPU speed.
212: *
213: * This is kicked by dvs_tick() if it needed.
214: */
215: static void
216: dpc_adjust_speed(void *arg)
217: {
218: int newspeed = (int)arg;
219:
220: DPRINTF(("DVS: new speed=%d\n", newspeed));
221: cpu_setperf(newspeed);
222: cur_speed = cpu_getperf();
223: }
224:
225: /*
226: * Timer hook routine called by tick handler.
227: */
228: static void
229: dvs_tick(int idle)
230: {
231: int newspeed;
232:
233: elapsed_ticks++;
234: if (idle)
235: idle_cycles++;
236: else
237: run_cycles++;
238:
239: if (elapsed_ticks < INTERVAL_TICK)
240: return;
241:
242: /* Predict max CPU speed */
243: max_speed = predict_max_speed(cur_speed);
244:
245: DPRINTF(("DVS: run_cycles=%d idle_cycles=%d cur_speed=%d "
246: "max_speed=%d\n",
247: run_cycles, idle_cycles, cur_speed, max_speed));
248: /*
249: * Predict next CPU speed
250: */
251: newspeed = predict_cpu_speed(cur_speed);
252: if (newspeed != cur_speed) {
253: sched_dpc(&dvs_dpc, &dpc_adjust_speed, (void *)newspeed);
254: }
255: run_cycles = 0;
256: idle_cycles = 0;
257: elapsed_ticks = 0;
258: }
259:
260: /*
261: * Enable DVS operation
262: */
263: static void
264: dvs_enable(void)
265: {
266:
267: if (!dvs_capable)
268: return;
269:
270: run_cycles = 0;
271: idle_cycles = 0;
272: elapsed_ticks = 0;
273:
274: max_speed = 100; /* max 100% */
275: min_speed = 5; /* min 5% */
276: cur_speed = cpu_getperf();
277:
278: timer_hook(dvs_tick);
279: dvs_enabled = 1;
280: }
281:
282: /*
283: * Disable DVS operation
284: */
285: static void
286: dvs_disable(void)
287: {
288:
289: if (!dvs_capable)
290: return;
291:
292: timer_hook(NULL);
293:
294: /* Set CPU speed to 100% */
295: cpu_setperf(100);
296: dvs_enabled = 0;
297: }
298:
299: static int
300: cpufreq_open(device_t dev, int mode)
301: {
302:
303: return 0;
304: }
305:
306: static int
307: cpufreq_close(device_t dev)
308: {
309:
310: return 0;
311: }
312:
313: static int
314: cpufreq_ioctl(device_t dev, u_long cmd, void *arg)
315: {
316:
317: return 0;
318: }
319:
320: void
321: cpufreq_setpolicy(int policy)
322: {
323:
324: switch (cpufreq_policy) {
325: case CPUFREQ_ONDEMAND:
326: if (policy == PM_POWERSAVE)
327: dvs_enable();
328: else
329: dvs_disable();
330:
331: break;
332: case CPUFREQ_MAXSPEED:
333: break;
334: case CPUFREQ_MINSPEED:
335: break;
336: }
337: }
338:
339: static int
340: cpufreq_init(void)
341: {
342: int policy;
343:
344: if (cpu_initperf())
345: return -1;
346:
347: /* Create device object */
348: cpufreq_dev = device_create(&cpufreq_io, "cpufreq", DF_CHR);
349: ASSERT(cpufreq_dev);
350:
351: dvs_capable = 1;
352:
353: policy = pm_getpolicy();
354: if (policy == PM_POWERSAVE)
355: dvs_enable();
356: return 0;
357: }
358:
CVSweb