diff options
author | Paul Walmsley <paul@pwsan.com> | 2010-01-26 22:13:06 -0500 |
---|---|---|
committer | Paul Walmsley <paul@pwsan.com> | 2010-01-26 22:13:06 -0500 |
commit | 734f69a773d8ff65111562116c18c987049ddac4 (patch) | |
tree | 48626f19e48bce04455dd0f7efb07e1e187d0f68 /arch/arm/mach-omap2/clock2xxx.c | |
parent | b1823d8616b11477e9e0967c727ed5325fb12403 (diff) |
OMAP2xxx clock: move the DVFS virtual clock code into mach-omap2/clkt2xxx_virt_prcm_set.c
Move the DVFS virtual clock functions from clock2xxx.c to
mach-omap2/clkt2xxx_virt_prcm_set.c. This is intended to make the
clock code easier to understand, since all of the functions needed to
manage the virt_prcm_set clock are now located in their own file,
rather than being mixed with other, unrelated functions.
Clock debugging is also now more finely-grained, since the DEBUG macro
can now be defined for the virt_prcm_set clock alone. This should
reduce unnecessary console noise when debugging.
Also, if at some future point the mach-omap2/ directory is split into
OMAP2/3/4 variants, this clkt file can be placed in the mach-omap2xxx/
directory, rather than shared with other chip types that don't use
this clock type.
Thanks to Alexander Shishkin <virtuoso@slind.org> for his comments.
Thanks also to Kevin Hilman <khilman@deeprootsystems.com> for finding
and fixing a bug with the CONFIG_CPU_FREQ portion of this patch.
Signed-off-by: Paul Walmsley <paul@pwsan.com>
Cc: Richard Woodruff <r-woodruff2@ti.com>
Cc: Alexander Shishkin <virtuoso@slind.org>
Cc: Kevin Hilman <khilman@deeprootsystems.com>
Diffstat (limited to 'arch/arm/mach-omap2/clock2xxx.c')
-rw-r--r-- | arch/arm/mach-omap2/clock2xxx.c | 211 |
1 files changed, 0 insertions, 211 deletions
diff --git a/arch/arm/mach-omap2/clock2xxx.c b/arch/arm/mach-omap2/clock2xxx.c index 419ae80fa1d4..11d6edb0b32f 100644 --- a/arch/arm/mach-omap2/clock2xxx.c +++ b/arch/arm/mach-omap2/clock2xxx.c | |||
@@ -54,9 +54,6 @@ | |||
54 | #define APLLS_CLKIN_13MHZ 2 | 54 | #define APLLS_CLKIN_13MHZ 2 |
55 | #define APLLS_CLKIN_12MHZ 3 | 55 | #define APLLS_CLKIN_12MHZ 3 |
56 | 56 | ||
57 | const struct prcm_config *curr_prcm_set; | ||
58 | const struct prcm_config *rate_table; | ||
59 | |||
60 | struct clk *vclk, *sclk, *dclk; | 57 | struct clk *vclk, *sclk, *dclk; |
61 | 58 | ||
62 | void __iomem *prcm_clksrc_ctrl; | 59 | void __iomem *prcm_clksrc_ctrl; |
@@ -185,214 +182,6 @@ const struct clkops clkops_apll54 = { | |||
185 | .disable = omap2_clk_apll_disable, | 182 | .disable = omap2_clk_apll_disable, |
186 | }; | 183 | }; |
187 | 184 | ||
188 | /** | ||
189 | * omap2_table_mpu_recalc - just return the MPU speed | ||
190 | * @clk: virt_prcm_set struct clk | ||
191 | * | ||
192 | * Set virt_prcm_set's rate to the mpu_speed field of the current PRCM set. | ||
193 | */ | ||
194 | unsigned long omap2_table_mpu_recalc(struct clk *clk) | ||
195 | { | ||
196 | return curr_prcm_set->mpu_speed; | ||
197 | } | ||
198 | |||
199 | /* | ||
200 | * Look for a rate equal or less than the target rate given a configuration set. | ||
201 | * | ||
202 | * What's not entirely clear is "which" field represents the key field. | ||
203 | * Some might argue L3-DDR, others ARM, others IVA. This code is simple and | ||
204 | * just uses the ARM rates. | ||
205 | */ | ||
206 | long omap2_round_to_table_rate(struct clk *clk, unsigned long rate) | ||
207 | { | ||
208 | const struct prcm_config *ptr; | ||
209 | long highest_rate; | ||
210 | long sys_ck_rate; | ||
211 | |||
212 | sys_ck_rate = clk_get_rate(sclk); | ||
213 | |||
214 | highest_rate = -EINVAL; | ||
215 | |||
216 | for (ptr = rate_table; ptr->mpu_speed; ptr++) { | ||
217 | if (!(ptr->flags & cpu_mask)) | ||
218 | continue; | ||
219 | if (ptr->xtal_speed != sys_ck_rate) | ||
220 | continue; | ||
221 | |||
222 | highest_rate = ptr->mpu_speed; | ||
223 | |||
224 | /* Can check only after xtal frequency check */ | ||
225 | if (ptr->mpu_speed <= rate) | ||
226 | break; | ||
227 | } | ||
228 | return highest_rate; | ||
229 | } | ||
230 | |||
231 | /* Sets basic clocks based on the specified rate */ | ||
232 | int omap2_select_table_rate(struct clk *clk, unsigned long rate) | ||
233 | { | ||
234 | u32 cur_rate, done_rate, bypass = 0, tmp; | ||
235 | const struct prcm_config *prcm; | ||
236 | unsigned long found_speed = 0; | ||
237 | unsigned long flags; | ||
238 | long sys_ck_rate; | ||
239 | |||
240 | sys_ck_rate = clk_get_rate(sclk); | ||
241 | |||
242 | for (prcm = rate_table; prcm->mpu_speed; prcm++) { | ||
243 | if (!(prcm->flags & cpu_mask)) | ||
244 | continue; | ||
245 | |||
246 | if (prcm->xtal_speed != sys_ck_rate) | ||
247 | continue; | ||
248 | |||
249 | if (prcm->mpu_speed <= rate) { | ||
250 | found_speed = prcm->mpu_speed; | ||
251 | break; | ||
252 | } | ||
253 | } | ||
254 | |||
255 | if (!found_speed) { | ||
256 | printk(KERN_INFO "Could not set MPU rate to %luMHz\n", | ||
257 | rate / 1000000); | ||
258 | return -EINVAL; | ||
259 | } | ||
260 | |||
261 | curr_prcm_set = prcm; | ||
262 | cur_rate = omap2xxx_clk_get_core_rate(dclk); | ||
263 | |||
264 | if (prcm->dpll_speed == cur_rate / 2) { | ||
265 | omap2xxx_sdrc_reprogram(CORE_CLK_SRC_DPLL, 1); | ||
266 | } else if (prcm->dpll_speed == cur_rate * 2) { | ||
267 | omap2xxx_sdrc_reprogram(CORE_CLK_SRC_DPLL_X2, 1); | ||
268 | } else if (prcm->dpll_speed != cur_rate) { | ||
269 | local_irq_save(flags); | ||
270 | |||
271 | if (prcm->dpll_speed == prcm->xtal_speed) | ||
272 | bypass = 1; | ||
273 | |||
274 | if ((prcm->cm_clksel2_pll & OMAP24XX_CORE_CLK_SRC_MASK) == | ||
275 | CORE_CLK_SRC_DPLL_X2) | ||
276 | done_rate = CORE_CLK_SRC_DPLL_X2; | ||
277 | else | ||
278 | done_rate = CORE_CLK_SRC_DPLL; | ||
279 | |||
280 | /* MPU divider */ | ||
281 | cm_write_mod_reg(prcm->cm_clksel_mpu, MPU_MOD, CM_CLKSEL); | ||
282 | |||
283 | /* dsp + iva1 div(2420), iva2.1(2430) */ | ||
284 | cm_write_mod_reg(prcm->cm_clksel_dsp, | ||
285 | OMAP24XX_DSP_MOD, CM_CLKSEL); | ||
286 | |||
287 | cm_write_mod_reg(prcm->cm_clksel_gfx, GFX_MOD, CM_CLKSEL); | ||
288 | |||
289 | /* Major subsystem dividers */ | ||
290 | tmp = cm_read_mod_reg(CORE_MOD, CM_CLKSEL1) & OMAP24XX_CLKSEL_DSS2_MASK; | ||
291 | cm_write_mod_reg(prcm->cm_clksel1_core | tmp, CORE_MOD, | ||
292 | CM_CLKSEL1); | ||
293 | |||
294 | if (cpu_is_omap2430()) | ||
295 | cm_write_mod_reg(prcm->cm_clksel_mdm, | ||
296 | OMAP2430_MDM_MOD, CM_CLKSEL); | ||
297 | |||
298 | /* x2 to enter omap2xxx_sdrc_init_params() */ | ||
299 | omap2xxx_sdrc_reprogram(CORE_CLK_SRC_DPLL_X2, 1); | ||
300 | |||
301 | omap2_set_prcm(prcm->cm_clksel1_pll, prcm->base_sdrc_rfr, | ||
302 | bypass); | ||
303 | |||
304 | omap2xxx_sdrc_init_params(omap2xxx_sdrc_dll_is_unlocked()); | ||
305 | omap2xxx_sdrc_reprogram(done_rate, 0); | ||
306 | |||
307 | local_irq_restore(flags); | ||
308 | } | ||
309 | |||
310 | return 0; | ||
311 | } | ||
312 | |||
313 | #ifdef CONFIG_CPU_FREQ | ||
314 | /* | ||
315 | * Walk PRCM rate table and fillout cpufreq freq_table | ||
316 | * XXX This should be replaced by an OPP layer in the near future | ||
317 | */ | ||
318 | static struct cpufreq_frequency_table *freq_table; | ||
319 | |||
320 | void omap2xxx_clk_init_cpufreq_table(struct cpufreq_frequency_table **table) | ||
321 | { | ||
322 | const struct prcm_config *prcm; | ||
323 | long sys_ck_rate; | ||
324 | int i = 0; | ||
325 | int tbl_sz = 0; | ||
326 | |||
327 | if (!cpu_is_omap2xxx()) | ||
328 | return; | ||
329 | |||
330 | sys_ck_rate = clk_get_rate(sclk); | ||
331 | |||
332 | for (prcm = rate_table; prcm->mpu_speed; prcm++) { | ||
333 | if (!(prcm->flags & cpu_mask)) | ||
334 | continue; | ||
335 | if (prcm->xtal_speed != sys_ck_rate) | ||
336 | continue; | ||
337 | |||
338 | /* don't put bypass rates in table */ | ||
339 | if (prcm->dpll_speed == prcm->xtal_speed) | ||
340 | continue; | ||
341 | |||
342 | tbl_sz++; | ||
343 | } | ||
344 | |||
345 | /* | ||
346 | * XXX Ensure that we're doing what CPUFreq expects for this error | ||
347 | * case and the following one | ||
348 | */ | ||
349 | if (tbl_sz == 0) { | ||
350 | pr_warning("%s: no matching entries in rate_table\n", | ||
351 | __func__); | ||
352 | return; | ||
353 | } | ||
354 | |||
355 | /* Include the CPUFREQ_TABLE_END terminator entry */ | ||
356 | tbl_sz++; | ||
357 | |||
358 | freq_table = kzalloc(sizeof(struct cpufreq_frequency_table) * tbl_sz, | ||
359 | GFP_ATOMIC); | ||
360 | if (!freq_table) { | ||
361 | pr_err("%s: could not kzalloc frequency table\n", __func__); | ||
362 | return; | ||
363 | } | ||
364 | |||
365 | for (prcm = rate_table; prcm->mpu_speed; prcm++) { | ||
366 | if (!(prcm->flags & cpu_mask)) | ||
367 | continue; | ||
368 | if (prcm->xtal_speed != sys_ck_rate) | ||
369 | continue; | ||
370 | |||
371 | /* don't put bypass rates in table */ | ||
372 | if (prcm->dpll_speed == prcm->xtal_speed) | ||
373 | continue; | ||
374 | |||
375 | freq_table[i].index = i; | ||
376 | freq_table[i].frequency = prcm->mpu_speed / 1000; | ||
377 | i++; | ||
378 | } | ||
379 | |||
380 | freq_table[i].index = i; | ||
381 | freq_table[i].frequency = CPUFREQ_TABLE_END; | ||
382 | |||
383 | *table = &freq_table[0]; | ||
384 | } | ||
385 | |||
386 | void omap2xxx_clk_exit_cpufreq_table(struct cpufreq_frequency_table **table) | ||
387 | { | ||
388 | if (!cpu_is_omap2xxx()) | ||
389 | return; | ||
390 | |||
391 | kfree(freq_table); | ||
392 | } | ||
393 | |||
394 | #endif | ||
395 | |||
396 | static u32 omap2_get_apll_clkin(void) | 185 | static u32 omap2_get_apll_clkin(void) |
397 | { | 186 | { |
398 | u32 aplls, srate = 0; | 187 | u32 aplls, srate = 0; |