blob: 823a400d98fd6bc5f8c627db8151df572ffc68b9 [file] [log] [blame]
Linus Torvalds1da177e2005-04-16 15:20:36 -07001/*
Dave Jones32ee8c32006-02-28 00:43:23 -05002 * elanfreq: cpufreq driver for the AMD ELAN family
Linus Torvalds1da177e2005-04-16 15:20:36 -07003 *
4 * (c) Copyright 2002 Robert Schwebel <r.schwebel@pengutronix.de>
5 *
Dave Jones32ee8c32006-02-28 00:43:23 -05006 * Parts of this code are (c) Sven Geggus <sven@geggus.net>
Linus Torvalds1da177e2005-04-16 15:20:36 -07007 *
Dave Jones32ee8c32006-02-28 00:43:23 -05008 * All Rights Reserved.
Linus Torvalds1da177e2005-04-16 15:20:36 -07009 *
10 * This program is free software; you can redistribute it and/or
11 * modify it under the terms of the GNU General Public License
12 * as published by the Free Software Foundation; either version
Dave Jones32ee8c32006-02-28 00:43:23 -050013 * 2 of the License, or (at your option) any later version.
Linus Torvalds1da177e2005-04-16 15:20:36 -070014 *
15 * 2002-02-13: - initial revision for 2.4.18-pre9 by Robert Schwebel
16 *
17 */
18
19#include <linux/kernel.h>
20#include <linux/module.h>
21#include <linux/init.h>
22
Linus Torvalds1da177e2005-04-16 15:20:36 -070023#include <linux/delay.h>
24#include <linux/cpufreq.h>
25
Andi Kleenfa8031a2012-01-26 00:09:12 +010026#include <asm/cpu_device_id.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070027#include <asm/msr.h>
Paolo Ciarrocchi18c6faa2008-07-28 13:00:49 +020028#include <linux/timex.h>
29#include <linux/io.h>
Linus Torvalds1da177e2005-04-16 15:20:36 -070030
Dave Jones32ee8c32006-02-28 00:43:23 -050031#define REG_CSCIR 0x22 /* Chip Setup and Control Index Register */
Linus Torvalds1da177e2005-04-16 15:20:36 -070032#define REG_CSCDR 0x23 /* Chip Setup and Control Data Register */
33
34/* Module parameter */
35static int max_freq;
36
37struct s_elan_multiplier {
38 int clock; /* frequency in kHz */
39 int val40h; /* PMU Force Mode register */
40 int val80h; /* CPU Clock Speed Register */
41};
42
43/*
Dave Jones32ee8c32006-02-28 00:43:23 -050044 * It is important that the frequencies
Linus Torvalds1da177e2005-04-16 15:20:36 -070045 * are listed in ascending order here!
46 */
Dave Jones460f5ef2008-07-30 13:01:42 -040047static struct s_elan_multiplier elan_multiplier[] = {
Linus Torvalds1da177e2005-04-16 15:20:36 -070048 {1000, 0x02, 0x18},
49 {2000, 0x02, 0x10},
50 {4000, 0x02, 0x08},
51 {8000, 0x00, 0x00},
52 {16000, 0x00, 0x02},
53 {33000, 0x00, 0x04},
54 {66000, 0x01, 0x04},
55 {99000, 0x01, 0x05}
56};
57
58static struct cpufreq_frequency_table elanfreq_table[] = {
59 {0, 1000},
60 {1, 2000},
61 {2, 4000},
62 {3, 8000},
63 {4, 16000},
64 {5, 33000},
65 {6, 66000},
66 {7, 99000},
67 {0, CPUFREQ_TABLE_END},
68};
69
70
71/**
72 * elanfreq_get_cpu_frequency: determine current cpu speed
73 *
74 * Finds out at which frequency the CPU of the Elan SOC runs
Dave Jones32ee8c32006-02-28 00:43:23 -050075 * at the moment. Frequencies from 1 to 33 MHz are generated
Linus Torvalds1da177e2005-04-16 15:20:36 -070076 * the normal way, 66 and 99 MHz are called "Hyperspeed Mode"
Dave Jones32ee8c32006-02-28 00:43:23 -050077 * and have the rest of the chip running with 33 MHz.
Linus Torvalds1da177e2005-04-16 15:20:36 -070078 */
79
80static unsigned int elanfreq_get_cpu_frequency(unsigned int cpu)
81{
Dave Jones32ee8c32006-02-28 00:43:23 -050082 u8 clockspeed_reg; /* Clock Speed Register */
83
Linus Torvalds1da177e2005-04-16 15:20:36 -070084 local_irq_disable();
Paolo Ciarrocchi18c6faa2008-07-28 13:00:49 +020085 outb_p(0x80, REG_CSCIR);
Dave Jones32ee8c32006-02-28 00:43:23 -050086 clockspeed_reg = inb_p(REG_CSCDR);
Linus Torvalds1da177e2005-04-16 15:20:36 -070087 local_irq_enable();
88
Dave Jones32ee8c32006-02-28 00:43:23 -050089 if ((clockspeed_reg & 0xE0) == 0xE0)
90 return 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -070091
Dave Jones32ee8c32006-02-28 00:43:23 -050092 /* Are we in CPU clock multiplied mode (66/99 MHz)? */
93 if ((clockspeed_reg & 0xE0) == 0xC0) {
94 if ((clockspeed_reg & 0x01) == 0)
Linus Torvalds1da177e2005-04-16 15:20:36 -070095 return 66000;
Dave Jones32ee8c32006-02-28 00:43:23 -050096 else
97 return 99000;
98 }
Linus Torvalds1da177e2005-04-16 15:20:36 -070099
100 /* 33 MHz is not 32 MHz... */
Paolo Ciarrocchi18c6faa2008-07-28 13:00:49 +0200101 if ((clockspeed_reg & 0xE0) == 0xA0)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700102 return 33000;
103
Paolo Ciarrocchi18c6faa2008-07-28 13:00:49 +0200104 return (1<<((clockspeed_reg & 0xE0) >> 5)) * 1000;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700105}
106
107
108/**
Dave Jones32ee8c32006-02-28 00:43:23 -0500109 * elanfreq_set_cpu_frequency: Change the CPU core frequency
110 * @cpu: cpu number
Linus Torvalds1da177e2005-04-16 15:20:36 -0700111 * @freq: frequency in kHz
112 *
Dave Jones32ee8c32006-02-28 00:43:23 -0500113 * This function takes a frequency value and changes the CPU frequency
Linus Torvalds1da177e2005-04-16 15:20:36 -0700114 * according to this. Note that the frequency has to be checked by
115 * elanfreq_validatespeed() for correctness!
Dave Jones32ee8c32006-02-28 00:43:23 -0500116 *
117 * There is no return value.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700118 */
119
Viresh Kumarb43a7ff2013-03-24 11:56:43 +0530120static void elanfreq_set_cpu_state(struct cpufreq_policy *policy,
121 unsigned int state)
Dave Jones32ee8c32006-02-28 00:43:23 -0500122{
Linus Torvalds1da177e2005-04-16 15:20:36 -0700123 struct cpufreq_freqs freqs;
124
125 freqs.old = elanfreq_get_cpu_frequency(0);
126 freqs.new = elan_multiplier[state].clock;
Dave Jones32ee8c32006-02-28 00:43:23 -0500127
Viresh Kumarb43a7ff2013-03-24 11:56:43 +0530128 cpufreq_notify_transition(policy, &freqs, CPUFREQ_PRECHANGE);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700129
Dave Jones32ee8c32006-02-28 00:43:23 -0500130 printk(KERN_INFO "elanfreq: attempting to set frequency to %i kHz\n",
131 elan_multiplier[state].clock);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700132
133
Dave Jones32ee8c32006-02-28 00:43:23 -0500134 /*
135 * Access to the Elan's internal registers is indexed via
136 * 0x22: Chip Setup & Control Register Index Register (CSCI)
137 * 0x23: Chip Setup & Control Register Data Register (CSCD)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700138 *
139 */
140
Dave Jones32ee8c32006-02-28 00:43:23 -0500141 /*
142 * 0x40 is the Power Management Unit's Force Mode Register.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700143 * Bit 6 enables Hyperspeed Mode (66/100 MHz core frequency)
144 */
145
146 local_irq_disable();
Paolo Ciarrocchi18c6faa2008-07-28 13:00:49 +0200147 outb_p(0x40, REG_CSCIR); /* Disable hyperspeed mode */
148 outb_p(0x00, REG_CSCDR);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700149 local_irq_enable(); /* wait till internal pipelines and */
150 udelay(1000); /* buffers have cleaned up */
151
152 local_irq_disable();
153
154 /* now, set the CPU clock speed register (0x80) */
Paolo Ciarrocchi18c6faa2008-07-28 13:00:49 +0200155 outb_p(0x80, REG_CSCIR);
156 outb_p(elan_multiplier[state].val80h, REG_CSCDR);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700157
158 /* now, the hyperspeed bit in PMU Force Mode Register (0x40) */
Paolo Ciarrocchi18c6faa2008-07-28 13:00:49 +0200159 outb_p(0x40, REG_CSCIR);
160 outb_p(elan_multiplier[state].val40h, REG_CSCDR);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700161 udelay(10000);
162 local_irq_enable();
163
Viresh Kumarb43a7ff2013-03-24 11:56:43 +0530164 cpufreq_notify_transition(policy, &freqs, CPUFREQ_POSTCHANGE);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700165};
166
167
168/**
169 * elanfreq_validatespeed: test if frequency range is valid
Dave Jones32ee8c32006-02-28 00:43:23 -0500170 * @policy: the policy to validate
Linus Torvalds1da177e2005-04-16 15:20:36 -0700171 *
Dave Jones32ee8c32006-02-28 00:43:23 -0500172 * This function checks if a given frequency range in kHz is valid
173 * for the hardware supported by the driver.
Linus Torvalds1da177e2005-04-16 15:20:36 -0700174 */
175
Paolo Ciarrocchi18c6faa2008-07-28 13:00:49 +0200176static int elanfreq_verify(struct cpufreq_policy *policy)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700177{
178 return cpufreq_frequency_table_verify(policy, &elanfreq_table[0]);
179}
180
Paolo Ciarrocchi18c6faa2008-07-28 13:00:49 +0200181static int elanfreq_target(struct cpufreq_policy *policy,
Dave Jones32ee8c32006-02-28 00:43:23 -0500182 unsigned int target_freq,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700183 unsigned int relation)
184{
Dave Jones32ee8c32006-02-28 00:43:23 -0500185 unsigned int newstate = 0;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700186
Dave Jones04cd1a92009-01-17 22:50:33 -0500187 if (cpufreq_frequency_table_target(policy, &elanfreq_table[0],
188 target_freq, relation, &newstate))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700189 return -EINVAL;
190
Viresh Kumarb43a7ff2013-03-24 11:56:43 +0530191 elanfreq_set_cpu_state(policy, newstate);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700192
193 return 0;
194}
195
196
197/*
198 * Module init and exit code
199 */
200
201static int elanfreq_cpu_init(struct cpufreq_policy *policy)
202{
Mike Travis92cb7612007-10-19 20:35:04 +0200203 struct cpuinfo_x86 *c = &cpu_data(0);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700204 unsigned int i;
205 int result;
206
207 /* capability check */
208 if ((c->x86_vendor != X86_VENDOR_AMD) ||
Paolo Ciarrocchi18c6faa2008-07-28 13:00:49 +0200209 (c->x86 != 4) || (c->x86_model != 10))
Linus Torvalds1da177e2005-04-16 15:20:36 -0700210 return -ENODEV;
211
212 /* max freq */
213 if (!max_freq)
214 max_freq = elanfreq_get_cpu_frequency(0);
215
216 /* table init */
Paolo Ciarrocchi18c6faa2008-07-28 13:00:49 +0200217 for (i = 0; (elanfreq_table[i].frequency != CPUFREQ_TABLE_END); i++) {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700218 if (elanfreq_table[i].frequency > max_freq)
219 elanfreq_table[i].frequency = CPUFREQ_ENTRY_INVALID;
220 }
221
222 /* cpuinfo and default policy values */
Linus Torvalds1da177e2005-04-16 15:20:36 -0700223 policy->cpuinfo.transition_latency = CPUFREQ_ETERNAL;
224 policy->cur = elanfreq_get_cpu_frequency(0);
225
226 result = cpufreq_frequency_table_cpuinfo(policy, elanfreq_table);
227 if (result)
Paolo Ciarrocchi18c6faa2008-07-28 13:00:49 +0200228 return result;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700229
Dave Jones32ee8c32006-02-28 00:43:23 -0500230 cpufreq_frequency_table_get_attr(elanfreq_table, policy->cpu);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700231 return 0;
232}
233
234
235static int elanfreq_cpu_exit(struct cpufreq_policy *policy)
236{
237 cpufreq_frequency_table_put_attr(policy->cpu);
238 return 0;
239}
240
241
242#ifndef MODULE
243/**
244 * elanfreq_setup - elanfreq command line parameter parsing
245 *
246 * elanfreq command line parameter. Use:
247 * elanfreq=66000
248 * to set the maximum CPU frequency to 66 MHz. Note that in
249 * case you do not give this boot parameter, the maximum
250 * frequency will fall back to _current_ CPU frequency which
251 * might be lower. If you build this as a module, use the
252 * max_freq module parameter instead.
253 */
254static int __init elanfreq_setup(char *str)
255{
256 max_freq = simple_strtoul(str, &str, 0);
257 printk(KERN_WARNING "You're using the deprecated elanfreq command line option. Use elanfreq.max_freq instead, please!\n");
258 return 1;
259}
260__setup("elanfreq=", elanfreq_setup);
261#endif
262
263
Paolo Ciarrocchi18c6faa2008-07-28 13:00:49 +0200264static struct freq_attr *elanfreq_attr[] = {
Linus Torvalds1da177e2005-04-16 15:20:36 -0700265 &cpufreq_freq_attr_scaling_available_freqs,
266 NULL,
267};
268
269
Linus Torvalds221dee22007-02-26 14:55:48 -0800270static struct cpufreq_driver elanfreq_driver = {
Dave Jones32ee8c32006-02-28 00:43:23 -0500271 .get = elanfreq_get_cpu_frequency,
272 .verify = elanfreq_verify,
273 .target = elanfreq_target,
Linus Torvalds1da177e2005-04-16 15:20:36 -0700274 .init = elanfreq_cpu_init,
275 .exit = elanfreq_cpu_exit,
276 .name = "elanfreq",
Linus Torvalds1da177e2005-04-16 15:20:36 -0700277 .attr = elanfreq_attr,
278};
279
Andi Kleenfa8031a2012-01-26 00:09:12 +0100280static const struct x86_cpu_id elan_id[] = {
281 { X86_VENDOR_AMD, 4, 10, },
282 {}
283};
284MODULE_DEVICE_TABLE(x86cpu, elan_id);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700285
Dave Jones32ee8c32006-02-28 00:43:23 -0500286static int __init elanfreq_init(void)
287{
Andi Kleenfa8031a2012-01-26 00:09:12 +0100288 if (!x86_match_cpu(elan_id))
Paolo Ciarrocchi18c6faa2008-07-28 13:00:49 +0200289 return -ENODEV;
Linus Torvalds1da177e2005-04-16 15:20:36 -0700290 return cpufreq_register_driver(&elanfreq_driver);
291}
292
293
Dave Jones32ee8c32006-02-28 00:43:23 -0500294static void __exit elanfreq_exit(void)
Linus Torvalds1da177e2005-04-16 15:20:36 -0700295{
296 cpufreq_unregister_driver(&elanfreq_driver);
297}
298
299
Paolo Ciarrocchi18c6faa2008-07-28 13:00:49 +0200300module_param(max_freq, int, 0444);
Linus Torvalds1da177e2005-04-16 15:20:36 -0700301
302MODULE_LICENSE("GPL");
Dave Jones04cd1a92009-01-17 22:50:33 -0500303MODULE_AUTHOR("Robert Schwebel <r.schwebel@pengutronix.de>, "
304 "Sven Geggus <sven@geggus.net>");
Linus Torvalds1da177e2005-04-16 15:20:36 -0700305MODULE_DESCRIPTION("cpufreq driver for AMD's Elan CPUs");
306
307module_init(elanfreq_init);
308module_exit(elanfreq_exit);