blob: 6f5569bac131e3bb5b3d860ede43f6746a37cf48 [file] [log] [blame]
Russell King9e2697f2007-12-14 13:30:14 +00001/*
2 * linux/arch/arm/mach-pxa/cpu-pxa.c
3 *
4 * Copyright (C) 2002,2003 Intrinsyc Software
5 *
6 * This program is free software; you can redistribute it and/or modify
7 * it under the terms of the GNU General Public License as published by
8 * the Free Software Foundation; either version 2 of the License, or
9 * (at your option) any later version.
10 *
11 * This program is distributed in the hope that it will be useful,
12 * but WITHOUT ANY WARRANTY; without even the implied warranty of
13 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
14 * GNU General Public License for more details.
15 *
16 * You should have received a copy of the GNU General Public License
17 * along with this program; if not, write to the Free Software
18 * Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA 02111-1307 USA
19 *
20 * History:
21 * 31-Jul-2002 : Initial version [FB]
22 * 29-Jan-2003 : added PXA255 support [FB]
23 * 20-Apr-2003 : ported to v2.5 (Dustin McIntire, Sensoria Corp.)
24 *
25 * Note:
26 * This driver may change the memory bus clock rate, but will not do any
27 * platform specific access timing changes... for example if you have flash
28 * memory connected to CS0, you will need to register a platform specific
29 * notifier which will adjust the memory access strobes to maintain a
30 * minimum strobe width.
31 *
32 */
33
34#include <linux/kernel.h>
35#include <linux/module.h>
36#include <linux/sched.h>
37#include <linux/init.h>
38#include <linux/cpufreq.h>
39
Russell Kinga09e64f2008-08-05 16:14:15 +010040#include <mach/hardware.h>
41#include <mach/pxa-regs.h>
42#include <mach/pxa2xx-regs.h>
Russell King9e2697f2007-12-14 13:30:14 +000043
44#ifdef DEBUG
45static unsigned int freq_debug;
Randy Dunlapc710e392008-02-27 12:11:16 -080046module_param(freq_debug, uint, 0);
Russell King9e2697f2007-12-14 13:30:14 +000047MODULE_PARM_DESC(freq_debug, "Set the debug messages to on=1/off=0");
48#else
49#define freq_debug 0
50#endif
51
Robert Jarzmik592eb992008-05-07 20:39:06 +010052static unsigned int pxa27x_maxfreq;
53module_param(pxa27x_maxfreq, uint, 0);
54MODULE_PARM_DESC(pxa27x_maxfreq, "Set the pxa27x maxfreq in MHz"
55 "(typically 624=>pxa270, 416=>pxa271, 520=>pxa272)");
56
Russell King9e2697f2007-12-14 13:30:14 +000057typedef struct {
58 unsigned int khz;
59 unsigned int membus;
60 unsigned int cccr;
61 unsigned int div2;
Robert Jarzmik592eb992008-05-07 20:39:06 +010062 unsigned int cclkcfg;
Russell King9e2697f2007-12-14 13:30:14 +000063} pxa_freqs_t;
64
65/* Define the refresh period in mSec for the SDRAM and the number of rows */
Robert Jarzmik36793892008-05-07 20:36:34 +010066#define SDRAM_TREF 64 /* standard 64ms SDRAM */
67#define SDRAM_ROWS 4096 /* 64MB=8192 32MB=4096 */
Russell King9e2697f2007-12-14 13:30:14 +000068
Robert Jarzmik36793892008-05-07 20:36:34 +010069#define CCLKCFG_TURBO 0x1
70#define CCLKCFG_FCS 0x2
Robert Jarzmik592eb992008-05-07 20:39:06 +010071#define CCLKCFG_HALFTURBO 0x4
72#define CCLKCFG_FASTBUS 0x8
Robert Jarzmik36793892008-05-07 20:36:34 +010073#define MDREFR_DB2_MASK (MDREFR_K2DB2 | MDREFR_K1DB2)
74#define MDREFR_DRI_MASK 0xFFF
Russell King9e2697f2007-12-14 13:30:14 +000075
Robert Jarzmik592eb992008-05-07 20:39:06 +010076/*
77 * PXA255 definitions
78 */
Russell King9e2697f2007-12-14 13:30:14 +000079/* Use the run mode frequencies for the CPUFREQ_POLICY_PERFORMANCE policy */
Robert Jarzmik592eb992008-05-07 20:39:06 +010080#define CCLKCFG CCLKCFG_TURBO | CCLKCFG_FCS
81
Russell King9e2697f2007-12-14 13:30:14 +000082static pxa_freqs_t pxa255_run_freqs[] =
83{
Robert Jarzmik592eb992008-05-07 20:39:06 +010084 /* CPU MEMBUS CCCR DIV2 CCLKCFG run turbo PXbus SDRAM */
85 { 99500, 99500, 0x121, 1, CCLKCFG}, /* 99, 99, 50, 50 */
86 {132700, 132700, 0x123, 1, CCLKCFG}, /* 133, 133, 66, 66 */
87 {199100, 99500, 0x141, 0, CCLKCFG}, /* 199, 199, 99, 99 */
88 {265400, 132700, 0x143, 1, CCLKCFG}, /* 265, 265, 133, 66 */
89 {331800, 165900, 0x145, 1, CCLKCFG}, /* 331, 331, 166, 83 */
90 {398100, 99500, 0x161, 0, CCLKCFG}, /* 398, 398, 196, 99 */
Russell King9e2697f2007-12-14 13:30:14 +000091};
Russell King9e2697f2007-12-14 13:30:14 +000092
93/* Use the turbo mode frequencies for the CPUFREQ_POLICY_POWERSAVE policy */
94static pxa_freqs_t pxa255_turbo_freqs[] =
95{
Robert Jarzmik592eb992008-05-07 20:39:06 +010096 /* CPU MEMBUS CCCR DIV2 CCLKCFG run turbo PXbus SDRAM */
97 { 99500, 99500, 0x121, 1, CCLKCFG}, /* 99, 99, 50, 50 */
98 {199100, 99500, 0x221, 0, CCLKCFG}, /* 99, 199, 50, 99 */
99 {298500, 99500, 0x321, 0, CCLKCFG}, /* 99, 287, 50, 99 */
100 {298600, 99500, 0x1c1, 0, CCLKCFG}, /* 199, 287, 99, 99 */
101 {398100, 99500, 0x241, 0, CCLKCFG}, /* 199, 398, 99, 99 */
Russell King9e2697f2007-12-14 13:30:14 +0000102};
Robert Jarzmik592eb992008-05-07 20:39:06 +0100103
104#define NUM_PXA25x_RUN_FREQS ARRAY_SIZE(pxa255_run_freqs)
105#define NUM_PXA25x_TURBO_FREQS ARRAY_SIZE(pxa255_turbo_freqs)
Russell King9e2697f2007-12-14 13:30:14 +0000106
Robert Jarzmik36793892008-05-07 20:36:34 +0100107static struct cpufreq_frequency_table
Robert Jarzmik592eb992008-05-07 20:39:06 +0100108 pxa255_run_freq_table[NUM_PXA25x_RUN_FREQS+1];
109static struct cpufreq_frequency_table
110 pxa255_turbo_freq_table[NUM_PXA25x_TURBO_FREQS+1];
111
112/*
113 * PXA270 definitions
114 *
115 * For the PXA27x:
116 * Control variables are A, L, 2N for CCCR; B, HT, T for CLKCFG.
117 *
118 * A = 0 => memory controller clock from table 3-7,
119 * A = 1 => memory controller clock = system bus clock
120 * Run mode frequency = 13 MHz * L
121 * Turbo mode frequency = 13 MHz * L * N
122 * System bus frequency = 13 MHz * L / (B + 1)
123 *
124 * In CCCR:
125 * A = 1
126 * L = 16 oscillator to run mode ratio
127 * 2N = 6 2 * (turbo mode to run mode ratio)
128 *
129 * In CCLKCFG:
130 * B = 1 Fast bus mode
131 * HT = 0 Half-Turbo mode
132 * T = 1 Turbo mode
133 *
134 * For now, just support some of the combinations in table 3-7 of
135 * PXA27x Processor Family Developer's Manual to simplify frequency
136 * change sequences.
137 */
138#define PXA27x_CCCR(A, L, N2) (A << 25 | N2 << 7 | L)
139#define CCLKCFG2(B, HT, T) \
140 (CCLKCFG_FCS | \
141 ((B) ? CCLKCFG_FASTBUS : 0) | \
142 ((HT) ? CCLKCFG_HALFTURBO : 0) | \
143 ((T) ? CCLKCFG_TURBO : 0))
144
145static pxa_freqs_t pxa27x_freqs[] = {
146 {104000, 104000, PXA27x_CCCR(1, 8, 2), 0, CCLKCFG2(1, 0, 1)},
147 {156000, 104000, PXA27x_CCCR(1, 8, 6), 0, CCLKCFG2(1, 1, 1)},
148 {208000, 208000, PXA27x_CCCR(0, 16, 2), 1, CCLKCFG2(0, 0, 1)},
149 {312000, 208000, PXA27x_CCCR(1, 16, 3), 1, CCLKCFG2(1, 0, 1)},
150 {416000, 208000, PXA27x_CCCR(1, 16, 4), 1, CCLKCFG2(1, 0, 1)},
151 {520000, 208000, PXA27x_CCCR(1, 16, 5), 1, CCLKCFG2(1, 0, 1)},
152 {624000, 208000, PXA27x_CCCR(1, 16, 6), 1, CCLKCFG2(1, 0, 1)}
153};
154
155#define NUM_PXA27x_FREQS ARRAY_SIZE(pxa27x_freqs)
156static struct cpufreq_frequency_table
157 pxa27x_freq_table[NUM_PXA27x_FREQS+1];
Russell King9e2697f2007-12-14 13:30:14 +0000158
159extern unsigned get_clk_frequency_khz(int info);
160
Robert Jarzmik592eb992008-05-07 20:39:06 +0100161static void find_freq_tables(struct cpufreq_policy *policy,
162 struct cpufreq_frequency_table **freq_table,
163 pxa_freqs_t **pxa_freqs)
164{
165 if (cpu_is_pxa25x()) {
166 if (policy->policy == CPUFREQ_POLICY_PERFORMANCE) {
167 *pxa_freqs = pxa255_run_freqs;
168 *freq_table = pxa255_run_freq_table;
169 } else if (policy->policy == CPUFREQ_POLICY_POWERSAVE) {
170 *pxa_freqs = pxa255_turbo_freqs;
171 *freq_table = pxa255_turbo_freq_table;
172 } else {
173 printk("CPU PXA: Unknown policy found. "
174 "Using CPUFREQ_POLICY_PERFORMANCE\n");
175 *pxa_freqs = pxa255_run_freqs;
176 *freq_table = pxa255_run_freq_table;
177 }
178 }
179 if (cpu_is_pxa27x()) {
180 *pxa_freqs = pxa27x_freqs;
181 *freq_table = pxa27x_freq_table;
182 }
183}
184
185static void pxa27x_guess_max_freq(void)
186{
187 if (!pxa27x_maxfreq) {
188 pxa27x_maxfreq = 416000;
189 printk(KERN_INFO "PXA CPU 27x max frequency not defined "
190 "(pxa27x_maxfreq), assuming pxa271 with %dkHz maxfreq\n",
191 pxa27x_maxfreq);
192 } else {
193 pxa27x_maxfreq *= 1000;
194 }
195}
196
197static u32 mdrefr_dri(unsigned int freq)
198{
199 u32 dri = 0;
200
201 if (cpu_is_pxa25x())
202 dri = ((freq * SDRAM_TREF) / (SDRAM_ROWS * 32));
203 if (cpu_is_pxa27x())
204 dri = ((freq * SDRAM_TREF) / (SDRAM_ROWS - 31)) / 32;
205 return dri;
206}
207
Russell King9e2697f2007-12-14 13:30:14 +0000208/* find a valid frequency point */
209static int pxa_verify_policy(struct cpufreq_policy *policy)
210{
211 struct cpufreq_frequency_table *pxa_freqs_table;
Robert Jarzmik592eb992008-05-07 20:39:06 +0100212 pxa_freqs_t *pxa_freqs;
Russell King9e2697f2007-12-14 13:30:14 +0000213 int ret;
214
Robert Jarzmik592eb992008-05-07 20:39:06 +0100215 find_freq_tables(policy, &pxa_freqs_table, &pxa_freqs);
Russell King9e2697f2007-12-14 13:30:14 +0000216 ret = cpufreq_frequency_table_verify(policy, pxa_freqs_table);
217
218 if (freq_debug)
219 pr_debug("Verified CPU policy: %dKhz min to %dKhz max\n",
Robert Jarzmik36793892008-05-07 20:36:34 +0100220 policy->min, policy->max);
Russell King9e2697f2007-12-14 13:30:14 +0000221
222 return ret;
223}
224
Robert Jarzmik592eb992008-05-07 20:39:06 +0100225static unsigned int pxa_cpufreq_get(unsigned int cpu)
226{
227 return get_clk_frequency_khz(0);
228}
229
Russell King9e2697f2007-12-14 13:30:14 +0000230static int pxa_set_target(struct cpufreq_policy *policy,
Robert Jarzmik36793892008-05-07 20:36:34 +0100231 unsigned int target_freq,
232 unsigned int relation)
Russell King9e2697f2007-12-14 13:30:14 +0000233{
234 struct cpufreq_frequency_table *pxa_freqs_table;
235 pxa_freqs_t *pxa_freq_settings;
236 struct cpufreq_freqs freqs;
Holger Schurigea833f02008-02-11 16:53:15 +0100237 unsigned int idx;
Russell King9e2697f2007-12-14 13:30:14 +0000238 unsigned long flags;
Robert Jarzmik592eb992008-05-07 20:39:06 +0100239 unsigned int new_freq_cpu, new_freq_mem;
240 unsigned int unused, preset_mdrefr, postset_mdrefr, cclkcfg;
Russell King9e2697f2007-12-14 13:30:14 +0000241
242 /* Get the current policy */
Robert Jarzmik592eb992008-05-07 20:39:06 +0100243 find_freq_tables(policy, &pxa_freqs_table, &pxa_freq_settings);
Russell King9e2697f2007-12-14 13:30:14 +0000244
245 /* Lookup the next frequency */
246 if (cpufreq_frequency_table_target(policy, pxa_freqs_table,
Robert Jarzmik36793892008-05-07 20:36:34 +0100247 target_freq, relation, &idx)) {
Russell King9e2697f2007-12-14 13:30:14 +0000248 return -EINVAL;
249 }
250
Robert Jarzmik592eb992008-05-07 20:39:06 +0100251 new_freq_cpu = pxa_freq_settings[idx].khz;
252 new_freq_mem = pxa_freq_settings[idx].membus;
Russell King9e2697f2007-12-14 13:30:14 +0000253 freqs.old = policy->cur;
Robert Jarzmik592eb992008-05-07 20:39:06 +0100254 freqs.new = new_freq_cpu;
Russell King9e2697f2007-12-14 13:30:14 +0000255 freqs.cpu = policy->cpu;
256
257 if (freq_debug)
Robert Jarzmik36793892008-05-07 20:36:34 +0100258 pr_debug(KERN_INFO "Changing CPU frequency to %d Mhz, "
259 "(SDRAM %d Mhz)\n",
260 freqs.new / 1000, (pxa_freq_settings[idx].div2) ?
Robert Jarzmik592eb992008-05-07 20:39:06 +0100261 (new_freq_mem / 2000) : (new_freq_mem / 1000));
Russell King9e2697f2007-12-14 13:30:14 +0000262
263 /*
264 * Tell everyone what we're about to do...
265 * you should add a notify client with any platform specific
266 * Vcc changing capability
267 */
268 cpufreq_notify_transition(&freqs, CPUFREQ_PRECHANGE);
269
270 /* Calculate the next MDREFR. If we're slowing down the SDRAM clock
Robert Jarzmik36793892008-05-07 20:36:34 +0100271 * we need to preset the smaller DRI before the change. If we're
272 * speeding up we need to set the larger DRI value after the change.
Russell King9e2697f2007-12-14 13:30:14 +0000273 */
274 preset_mdrefr = postset_mdrefr = MDREFR;
Robert Jarzmik592eb992008-05-07 20:39:06 +0100275 if ((MDREFR & MDREFR_DRI_MASK) > mdrefr_dri(new_freq_mem)) {
276 preset_mdrefr = (preset_mdrefr & ~MDREFR_DRI_MASK);
277 preset_mdrefr |= mdrefr_dri(new_freq_mem);
Russell King9e2697f2007-12-14 13:30:14 +0000278 }
Robert Jarzmik592eb992008-05-07 20:39:06 +0100279 postset_mdrefr =
280 (postset_mdrefr & ~MDREFR_DRI_MASK) | mdrefr_dri(new_freq_mem);
Russell King9e2697f2007-12-14 13:30:14 +0000281
282 /* If we're dividing the memory clock by two for the SDRAM clock, this
283 * must be set prior to the change. Clearing the divide must be done
284 * after the change.
285 */
286 if (pxa_freq_settings[idx].div2) {
287 preset_mdrefr |= MDREFR_DB2_MASK;
288 postset_mdrefr |= MDREFR_DB2_MASK;
289 } else {
290 postset_mdrefr &= ~MDREFR_DB2_MASK;
291 }
292
293 local_irq_save(flags);
294
Robert Jarzmik592eb992008-05-07 20:39:06 +0100295 /* Set new the CCCR and prepare CCLKCFG */
Russell King9e2697f2007-12-14 13:30:14 +0000296 CCCR = pxa_freq_settings[idx].cccr;
Robert Jarzmik592eb992008-05-07 20:39:06 +0100297 cclkcfg = pxa_freq_settings[idx].cclkcfg;
Russell King9e2697f2007-12-14 13:30:14 +0000298
299 asm volatile(" \n\
300 ldr r4, [%1] /* load MDREFR */ \n\
301 b 2f \n\
Robert Jarzmik36793892008-05-07 20:36:34 +0100302 .align 5 \n\
Russell King9e2697f2007-12-14 13:30:14 +00003031: \n\
Robert Jarzmik592eb992008-05-07 20:39:06 +0100304 str %3, [%1] /* preset the MDREFR */ \n\
Russell King9e2697f2007-12-14 13:30:14 +0000305 mcr p14, 0, %2, c6, c0, 0 /* set CCLKCFG[FCS] */ \n\
Robert Jarzmik592eb992008-05-07 20:39:06 +0100306 str %4, [%1] /* postset the MDREFR */ \n\
Russell King9e2697f2007-12-14 13:30:14 +0000307 \n\
308 b 3f \n\
3092: b 1b \n\
3103: nop \n\
311 "
Robert Jarzmik36793892008-05-07 20:36:34 +0100312 : "=&r" (unused)
Robert Jarzmik592eb992008-05-07 20:39:06 +0100313 : "r" (&MDREFR), "r" (cclkcfg),
314 "r" (preset_mdrefr), "r" (postset_mdrefr)
Robert Jarzmik36793892008-05-07 20:36:34 +0100315 : "r4", "r5");
Russell King9e2697f2007-12-14 13:30:14 +0000316 local_irq_restore(flags);
317
318 /*
319 * Tell everyone what we've just done...
320 * you should add a notify client with any platform specific
321 * SDRAM refresh timer adjustments
322 */
323 cpufreq_notify_transition(&freqs, CPUFREQ_POSTCHANGE);
324
325 return 0;
326}
327
Robert Jarzmik592eb992008-05-07 20:39:06 +0100328static __init int pxa_cpufreq_init(struct cpufreq_policy *policy)
Russell King9e2697f2007-12-14 13:30:14 +0000329{
330 int i;
Robert Jarzmik592eb992008-05-07 20:39:06 +0100331 unsigned int freq;
332
333 /* try to guess pxa27x cpu */
334 if (cpu_is_pxa27x())
335 pxa27x_guess_max_freq();
Russell King9e2697f2007-12-14 13:30:14 +0000336
337 /* set default policy and cpuinfo */
338 policy->governor = CPUFREQ_DEFAULT_GOVERNOR;
Robert Jarzmik592eb992008-05-07 20:39:06 +0100339 if (cpu_is_pxa25x())
340 policy->policy = CPUFREQ_POLICY_PERFORMANCE;
Russell King9e2697f2007-12-14 13:30:14 +0000341 policy->cpuinfo.transition_latency = 1000; /* FIXME: 1 ms, assumed */
Robert Jarzmik36793892008-05-07 20:36:34 +0100342 policy->cur = get_clk_frequency_khz(0); /* current freq */
Russell King9e2697f2007-12-14 13:30:14 +0000343 policy->min = policy->max = policy->cur;
344
Robert Jarzmik592eb992008-05-07 20:39:06 +0100345 /* Generate pxa25x the run cpufreq_frequency_table struct */
346 for (i = 0; i < NUM_PXA25x_RUN_FREQS; i++) {
Russell King9e2697f2007-12-14 13:30:14 +0000347 pxa255_run_freq_table[i].frequency = pxa255_run_freqs[i].khz;
348 pxa255_run_freq_table[i].index = i;
349 }
Russell King9e2697f2007-12-14 13:30:14 +0000350 pxa255_run_freq_table[i].frequency = CPUFREQ_TABLE_END;
Robert Jarzmik592eb992008-05-07 20:39:06 +0100351
352 /* Generate pxa25x the turbo cpufreq_frequency_table struct */
353 for (i = 0; i < NUM_PXA25x_TURBO_FREQS; i++) {
Robert Jarzmik36793892008-05-07 20:36:34 +0100354 pxa255_turbo_freq_table[i].frequency =
355 pxa255_turbo_freqs[i].khz;
Russell King9e2697f2007-12-14 13:30:14 +0000356 pxa255_turbo_freq_table[i].index = i;
357 }
358 pxa255_turbo_freq_table[i].frequency = CPUFREQ_TABLE_END;
359
Robert Jarzmik592eb992008-05-07 20:39:06 +0100360 /* Generate the pxa27x cpufreq_frequency_table struct */
361 for (i = 0; i < NUM_PXA27x_FREQS; i++) {
362 freq = pxa27x_freqs[i].khz;
363 if (freq > pxa27x_maxfreq)
364 break;
365 pxa27x_freq_table[i].frequency = freq;
366 pxa27x_freq_table[i].index = i;
367 }
368 pxa27x_freq_table[i].frequency = CPUFREQ_TABLE_END;
369
370 /*
371 * Set the policy's minimum and maximum frequencies from the tables
372 * just constructed. This sets cpuinfo.mxx_freq, min and max.
373 */
374 if (cpu_is_pxa25x())
375 cpufreq_frequency_table_cpuinfo(policy, pxa255_run_freq_table);
376 else if (cpu_is_pxa27x())
377 cpufreq_frequency_table_cpuinfo(policy, pxa27x_freq_table);
378
Russell King9e2697f2007-12-14 13:30:14 +0000379 printk(KERN_INFO "PXA CPU frequency change support initialized\n");
380
381 return 0;
382}
383
384static struct cpufreq_driver pxa_cpufreq_driver = {
385 .verify = pxa_verify_policy,
386 .target = pxa_set_target,
387 .init = pxa_cpufreq_init,
Holger Schurigea833f02008-02-11 16:53:15 +0100388 .get = pxa_cpufreq_get,
Robert Jarzmik592eb992008-05-07 20:39:06 +0100389 .name = "PXA2xx",
Russell King9e2697f2007-12-14 13:30:14 +0000390};
391
392static int __init pxa_cpu_init(void)
393{
394 int ret = -ENODEV;
Robert Jarzmik592eb992008-05-07 20:39:06 +0100395 if (cpu_is_pxa25x() || cpu_is_pxa27x())
Russell King9e2697f2007-12-14 13:30:14 +0000396 ret = cpufreq_register_driver(&pxa_cpufreq_driver);
397 return ret;
398}
399
400static void __exit pxa_cpu_exit(void)
401{
Robert Jarzmik592eb992008-05-07 20:39:06 +0100402 cpufreq_unregister_driver(&pxa_cpufreq_driver);
Russell King9e2697f2007-12-14 13:30:14 +0000403}
404
405
Robert Jarzmik36793892008-05-07 20:36:34 +0100406MODULE_AUTHOR("Intrinsyc Software Inc.");
407MODULE_DESCRIPTION("CPU frequency changing driver for the PXA architecture");
Russell King9e2697f2007-12-14 13:30:14 +0000408MODULE_LICENSE("GPL");
409module_init(pxa_cpu_init);
410module_exit(pxa_cpu_exit);