aboutsummaryrefslogtreecommitdiffstats
path: root/arch/arm/mach-omap2
diff options
context:
space:
mode:
authorPaul Walmsley <paul@pwsan.com>2008-03-18 04:53:16 -0400
committerTony Lindgren <tony@atomide.com>2008-04-14 13:29:38 -0400
commit2150ef46f8b5b2a5e3e5c53c1b04c513276ad4f7 (patch)
treea741e606e31f5f9557280b20041fc241ce317f2d /arch/arm/mach-omap2
parente32744b02d2d8f5242720998c9f955d8545751ac (diff)
ARM: OMAP2: Remove old 24xx specific clock functions
Signed-off-by: Paul Walmsley <paul@pwsan.com> Signed-off-by: Tony Lindgren <tony@atomide.com>
Diffstat (limited to 'arch/arm/mach-omap2')
-rw-r--r--arch/arm/mach-omap2/clock24xx.c722
1 files changed, 0 insertions, 722 deletions
diff --git a/arch/arm/mach-omap2/clock24xx.c b/arch/arm/mach-omap2/clock24xx.c
index c3ccac1b7218..615b511c68c9 100644
--- a/arch/arm/mach-omap2/clock24xx.c
+++ b/arch/arm/mach-omap2/clock24xx.c
@@ -109,29 +109,6 @@ static u32 omap2_get_dpll_rate_24xx(struct clk *tclk)
109 return dpll_clk; 109 return dpll_clk;
110} 110}
111 111
112static void omap2_followparent_recalc(struct clk *clk)
113{
114 followparent_recalc(clk);
115}
116
117static void omap2_propagate_rate(struct clk * clk)
118{
119 if (!(clk->flags & RATE_FIXED))
120 clk->rate = clk->parent->rate;
121
122 propagate_rate(clk);
123}
124
125#ifdef OLD_CK
126static void omap2_set_osc_ck(int enable)
127{
128 if (enable)
129 PRCM_CLKSRC_CTRL &= ~(0x3 << 3);
130 else
131 PRCM_CLKSRC_CTRL |= 0x3 << 3;
132}
133#endif /* OLD_CK */
134
135/* Enable an APLL if off */ 112/* Enable an APLL if off */
136static int omap2_clk_fixed_enable(struct clk *clk) 113static int omap2_clk_fixed_enable(struct clk *clk)
137{ 114{
@@ -163,84 +140,6 @@ static int omap2_clk_fixed_enable(struct clk *clk)
163 return 0; 140 return 0;
164} 141}
165 142
166#ifdef OLD_CK
167static void omap2_clk_wait_ready(struct clk *clk)
168{
169 unsigned long reg, other_reg, st_reg;
170 u32 bit;
171 int i;
172
173 reg = (unsigned long) clk->enable_reg;
174 if (reg == (unsigned long) &CM_FCLKEN1_CORE ||
175 reg == (unsigned long) &CM_FCLKEN2_CORE)
176 other_reg = (reg & ~0xf0) | 0x10;
177 else if (reg == (unsigned long) &CM_ICLKEN1_CORE ||
178 reg == (unsigned long) &CM_ICLKEN2_CORE)
179 other_reg = (reg & ~0xf0) | 0x00;
180 else
181 return;
182
183 /* No check for DSS or cam clocks */
184 if ((reg & 0x0f) == 0) {
185 if (clk->enable_bit <= 1 || clk->enable_bit == 31)
186 return;
187 }
188
189 /* Check if both functional and interface clocks
190 * are running. */
191 bit = 1 << clk->enable_bit;
192 if (!(__raw_readl(other_reg) & bit))
193 return;
194 st_reg = (other_reg & ~0xf0) | 0x20;
195 i = 0;
196 while (!(__raw_readl(st_reg) & bit)) {
197 i++;
198 if (i == 100000) {
199 printk(KERN_ERR "Timeout enabling clock %s\n", clk->name);
200 break;
201 }
202 }
203 if (i)
204 pr_debug("Clock %s stable after %d loops\n", clk->name, i);
205}
206
207/* Enables clock without considering parent dependencies or use count
208 * REVISIT: Maybe change this to use clk->enable like on omap1?
209 */
210static int _omap2_clk_enable(struct clk * clk)
211{
212 u32 regval32;
213
214 if (clk->flags & ALWAYS_ENABLED)
215 return 0;
216
217 if (unlikely(clk == &osc_ck)) {
218 omap2_set_osc_ck(1);
219 return 0;
220 }
221
222 if (unlikely(clk->enable_reg == 0)) {
223 printk(KERN_ERR "clock.c: Enable for %s without enable code\n",
224 clk->name);
225 return 0;
226 }
227
228 if (clk->enable_reg == (void __iomem *)&CM_CLKEN_PLL) {
229 omap2_clk_fixed_enable(clk);
230 return 0;
231 }
232
233 regval32 = __raw_readl(clk->enable_reg);
234 regval32 |= (1 << clk->enable_bit);
235 __raw_writel(regval32, clk->enable_reg);
236 wmb();
237
238 omap2_clk_wait_ready(clk);
239
240 return 0;
241}
242#endif /* OLD_CK */
243
244/* Stop APLL */ 143/* Stop APLL */
245static void omap2_clk_fixed_disable(struct clk *clk) 144static void omap2_clk_fixed_disable(struct clk *clk)
246{ 145{
@@ -251,65 +150,6 @@ static void omap2_clk_fixed_disable(struct clk *clk)
251 cm_write_mod_reg(cval, PLL_MOD, CM_CLKEN); 150 cm_write_mod_reg(cval, PLL_MOD, CM_CLKEN);
252} 151}
253 152
254#ifdef OLD_CK
255/* Disables clock without considering parent dependencies or use count */
256static void _omap2_clk_disable(struct clk *clk)
257{
258 u32 regval32;
259
260 if (unlikely(clk == &osc_ck)) {
261 omap2_set_osc_ck(0);
262 return;
263 }
264
265 if (clk->enable_reg == 0)
266 return;
267
268 if (clk->enable_reg == (void __iomem *)&CM_CLKEN_PLL) {
269 omap2_clk_fixed_disable(clk);
270 return;
271 }
272
273 regval32 = __raw_readl(clk->enable_reg);
274 regval32 &= ~(1 << clk->enable_bit);
275 __raw_writel(regval32, clk->enable_reg);
276 wmb();
277}
278
279static int omap2_clk_enable(struct clk *clk)
280{
281 int ret = 0;
282
283 if (clk->usecount++ == 0) {
284 if (likely((u32)clk->parent))
285 ret = omap2_clk_enable(clk->parent);
286
287 if (unlikely(ret != 0)) {
288 clk->usecount--;
289 return ret;
290 }
291
292 ret = _omap2_clk_enable(clk);
293
294 if (unlikely(ret != 0) && clk->parent) {
295 omap2_clk_disable(clk->parent);
296 clk->usecount--;
297 }
298 }
299
300 return ret;
301}
302
303static void omap2_clk_disable(struct clk *clk)
304{
305 if (clk->usecount > 0 && !(--clk->usecount)) {
306 _omap2_clk_disable(clk);
307 if (likely((u32)clk->parent))
308 omap2_clk_disable(clk->parent);
309 }
310}
311#endif /* OLD_CK */
312
313/* 153/*
314 * Uses the current prcm set to tell if a rate is valid. 154 * Uses the current prcm set to tell if a rate is valid.
315 * You can go slower, but not faster within a given rate set. 155 * You can go slower, but not faster within a given rate set.
@@ -343,195 +183,6 @@ static u32 omap2_dpll_round_rate(unsigned long target_rate)
343 183
344} 184}
345 185
346#ifdef OLD_CK
347/*
348 * Used for clocks that are part of CLKSEL_xyz governed clocks.
349 * REVISIT: Maybe change to use clk->enable() functions like on omap1?
350 */
351static void omap2_clksel_recalc(struct clk * clk)
352{
353 u32 fixed = 0, div = 0;
354
355 if (clk == &dpll_ck) {
356 clk->rate = omap2_get_dpll_rate(clk);
357 fixed = 1;
358 div = 0;
359 }
360
361 if (clk == &iva1_mpu_int_ifck) {
362 div = 2;
363 fixed = 1;
364 }
365
366 if ((clk == &dss1_fck) && ((CM_CLKSEL1_CORE & (0x1f << 8)) == 0)) {
367 clk->rate = sys_ck.rate;
368 return;
369 }
370
371 if (!fixed) {
372 div = omap2_clksel_get_divisor(clk);
373 if (div == 0)
374 return;
375 }
376
377 if (div != 0) {
378 if (unlikely(clk->rate == clk->parent->rate / div))
379 return;
380 clk->rate = clk->parent->rate / div;
381 }
382
383 if (unlikely(clk->flags & RATE_PROPAGATES))
384 propagate_rate(clk);
385}
386
387/*
388 * Finds best divider value in an array based on the source and target
389 * rates. The divider array must be sorted with smallest divider first.
390 */
391static inline u32 omap2_divider_from_table(u32 size, u32 *div_array,
392 u32 src_rate, u32 tgt_rate)
393{
394 int i, test_rate;
395
396 if (div_array == NULL)
397 return ~1;
398
399 for (i=0; i < size; i++) {
400 test_rate = src_rate / *div_array;
401 if (test_rate <= tgt_rate)
402 return *div_array;
403 ++div_array;
404 }
405
406 return ~0; /* No acceptable divider */
407}
408
409/*
410 * Find divisor for the given clock and target rate.
411 *
412 * Note that this will not work for clocks which are part of CONFIG_PARTICIPANT,
413 * they are only settable as part of virtual_prcm set.
414 */
415static u32 omap2_clksel_round_rate(struct clk *tclk, u32 target_rate,
416 u32 *new_div)
417{
418 u32 gfx_div[] = {2, 3, 4};
419 u32 sysclkout_div[] = {1, 2, 4, 8, 16};
420 u32 dss1_div[] = {1, 2, 3, 4, 5, 6, 8, 9, 12, 16};
421 u32 vylnq_div[] = {1, 2, 3, 4, 6, 8, 9, 12, 16, 18};
422 u32 best_div = ~0, asize = 0;
423 u32 *div_array = NULL;
424
425 switch (tclk->flags & SRC_RATE_SEL_MASK) {
426 case CM_GFX_SEL1:
427 asize = 3;
428 div_array = gfx_div;
429 break;
430 case CM_PLL_SEL1:
431 return omap2_dpll_round_rate(target_rate);
432 case CM_SYSCLKOUT_SEL1:
433 asize = 5;
434 div_array = sysclkout_div;
435 break;
436 case CM_CORE_SEL1:
437 if(tclk == &dss1_fck){
438 if(tclk->parent == &core_ck){
439 asize = 10;
440 div_array = dss1_div;
441 } else {
442 *new_div = 0; /* fixed clk */
443 return(tclk->parent->rate);
444 }
445 } else if((tclk == &vlynq_fck) && cpu_is_omap2420()){
446 if(tclk->parent == &core_ck){
447 asize = 10;
448 div_array = vylnq_div;
449 } else {
450 *new_div = 0; /* fixed clk */
451 return(tclk->parent->rate);
452 }
453 }
454 break;
455 }
456
457 best_div = omap2_divider_from_table(asize, div_array,
458 tclk->parent->rate, target_rate);
459 if (best_div == ~0){
460 *new_div = 1;
461 return best_div; /* signal error */
462 }
463
464 *new_div = best_div;
465 return (tclk->parent->rate / best_div);
466}
467
468/* Given a clock and a rate apply a clock specific rounding function */
469static long omap2_clk_round_rate(struct clk *clk, unsigned long rate)
470{
471 u32 new_div = 0;
472 int valid_rate;
473
474 if (clk->flags & RATE_FIXED)
475 return clk->rate;
476
477 if (clk->flags & RATE_CKCTL) {
478 valid_rate = omap2_clksel_round_rate(clk, rate, &new_div);
479 return valid_rate;
480 }
481
482 if (clk->round_rate != 0)
483 return clk->round_rate(clk, rate);
484
485 return clk->rate;
486}
487
488/*
489 * Check the DLL lock state, and return tue if running in unlock mode.
490 * This is needed to compensate for the shifted DLL value in unlock mode.
491 */
492static u32 omap2_dll_force_needed(void)
493{
494 u32 dll_state = SDRC_DLLA_CTRL; /* dlla and dllb are a set */
495
496 if ((dll_state & (1 << 2)) == (1 << 2))
497 return 1;
498 else
499 return 0;
500}
501
502static u32 omap2_reprogram_sdrc(u32 level, u32 force)
503{
504 u32 slow_dll_ctrl, fast_dll_ctrl, m_type;
505 u32 prev = curr_perf_level, flags;
506
507 if ((curr_perf_level == level) && !force)
508 return prev;
509
510 m_type = omap2_memory_get_type();
511 slow_dll_ctrl = omap2_memory_get_slow_dll_ctrl();
512 fast_dll_ctrl = omap2_memory_get_fast_dll_ctrl();
513
514 if (level == PRCM_HALF_SPEED) {
515 local_irq_save(flags);
516 PRCM_VOLTSETUP = 0xffff;
517 omap2_sram_reprogram_sdrc(PRCM_HALF_SPEED,
518 slow_dll_ctrl, m_type);
519 curr_perf_level = PRCM_HALF_SPEED;
520 local_irq_restore(flags);
521 }
522 if (level == PRCM_FULL_SPEED) {
523 local_irq_save(flags);
524 PRCM_VOLTSETUP = 0xffff;
525 omap2_sram_reprogram_sdrc(PRCM_FULL_SPEED,
526 fast_dll_ctrl, m_type);
527 curr_perf_level = PRCM_FULL_SPEED;
528 local_irq_restore(flags);
529 }
530
531 return prev;
532}
533#endif /* OLD_CK */
534
535static void omap2_dpll_recalc(struct clk *clk) 186static void omap2_dpll_recalc(struct clk *clk)
536{ 187{
537 clk->rate = omap2_get_dpll_rate_24xx(clk); 188 clk->rate = omap2_get_dpll_rate_24xx(clk);
@@ -656,359 +307,6 @@ static long omap2_round_to_table_rate(struct clk *clk, unsigned long rate)
656 return highest_rate; 307 return highest_rate;
657} 308}
658 309
659#ifdef OLD_CK
660/*
661 * omap2_convert_field_to_div() - turn field value into integer divider
662 */
663static u32 omap2_clksel_to_divisor(u32 div_sel, u32 field_val)
664{
665 u32 i;
666 u32 clkout_array[] = {1, 2, 4, 8, 16};
667
668 if ((div_sel & SRC_RATE_SEL_MASK) == CM_SYSCLKOUT_SEL1) {
669 for (i = 0; i < 5; i++) {
670 if (field_val == i)
671 return clkout_array[i];
672 }
673 return ~0;
674 } else
675 return field_val;
676}
677
678/*
679 * Returns the CLKSEL divider register value
680 * REVISIT: This should be cleaned up to work nicely with void __iomem *
681 */
682static u32 omap2_get_clksel(u32 *div_sel, u32 *field_mask,
683 struct clk *clk)
684{
685 int ret = ~0;
686 u32 reg_val, div_off;
687 u32 div_addr = 0;
688 u32 mask = ~0;
689
690 div_off = clk->rate_offset;
691
692 switch ((*div_sel & SRC_RATE_SEL_MASK)) {
693 case CM_MPU_SEL1:
694 div_addr = (u32)&CM_CLKSEL_MPU;
695 mask = 0x1f;
696 break;
697 case CM_DSP_SEL1:
698 div_addr = (u32)&CM_CLKSEL_DSP;
699 if (cpu_is_omap2420()) {
700 if ((div_off == 0) || (div_off == 8))
701 mask = 0x1f;
702 else if (div_off == 5)
703 mask = 0x3;
704 } else if (cpu_is_omap2430()) {
705 if (div_off == 0)
706 mask = 0x1f;
707 else if (div_off == 5)
708 mask = 0x3;
709 }
710 break;
711 case CM_GFX_SEL1:
712 div_addr = (u32)&CM_CLKSEL_GFX;
713 if (div_off == 0)
714 mask = 0x7;
715 break;
716 case CM_MODEM_SEL1:
717 div_addr = (u32)&CM_CLKSEL_MDM;
718 if (div_off == 0)
719 mask = 0xf;
720 break;
721 case CM_SYSCLKOUT_SEL1:
722 div_addr = (u32)&PRCM_CLKOUT_CTRL;
723 if ((div_off == 3) || (div_off == 11))
724 mask= 0x3;
725 break;
726 case CM_CORE_SEL1:
727 div_addr = (u32)&CM_CLKSEL1_CORE;
728 switch (div_off) {
729 case 0: /* l3 */
730 case 8: /* dss1 */
731 case 15: /* vylnc-2420 */
732 case 20: /* ssi */
733 mask = 0x1f; break;
734 case 5: /* l4 */
735 mask = 0x3; break;
736 case 13: /* dss2 */
737 mask = 0x1; break;
738 case 25: /* usb */
739 mask = 0x7; break;
740 }
741 }
742
743 *field_mask = mask;
744
745 if (unlikely(mask == ~0))
746 div_addr = 0;
747
748 *div_sel = div_addr;
749
750 if (unlikely(div_addr == 0))
751 return ret;
752
753 /* Isolate field */
754 reg_val = __raw_readl((void __iomem *)div_addr) & (mask << div_off);
755
756 /* Normalize back to divider value */
757 reg_val >>= div_off;
758
759 return reg_val;
760}
761
762/*
763 * Return divider to be applied to parent clock.
764 * Return 0 on error.
765 */
766static u32 omap2_clksel_get_divisor(struct clk *clk)
767{
768 int ret = 0;
769 u32 div, div_sel, div_off, field_mask, field_val;
770
771 /* isolate control register */
772 div_sel = (SRC_RATE_SEL_MASK & clk->flags);
773
774 div_off = clk->rate_offset;
775 field_val = omap2_get_clksel(&div_sel, &field_mask, clk);
776 if (div_sel == 0)
777 return ret;
778
779 div_sel = (SRC_RATE_SEL_MASK & clk->flags);
780 div = omap2_clksel_to_divisor(div_sel, field_val);
781
782 return div;
783}
784
785/* Set the clock rate for a clock source */
786static int omap2_clk_set_rate(struct clk *clk, unsigned long rate)
787
788{
789 int ret = -EINVAL;
790 void __iomem * reg;
791 u32 div_sel, div_off, field_mask, field_val, reg_val, validrate;
792 u32 new_div = 0;
793
794 if (!(clk->flags & CONFIG_PARTICIPANT) && (clk->flags & RATE_CKCTL)) {
795 if (clk == &dpll_ck)
796 return omap2_reprogram_dpll(clk, rate);
797
798 /* Isolate control register */
799 div_sel = (SRC_RATE_SEL_MASK & clk->flags);
800 div_off = clk->rate_offset;
801
802 validrate = omap2_clksel_round_rate(clk, rate, &new_div);
803 if (validrate != rate)
804 return(ret);
805
806 field_val = omap2_get_clksel(&div_sel, &field_mask, clk);
807 if (div_sel == 0)
808 return ret;
809
810 if (clk->flags & CM_SYSCLKOUT_SEL1) {
811 switch (new_div) {
812 case 16:
813 field_val = 4;
814 break;
815 case 8:
816 field_val = 3;
817 break;
818 case 4:
819 field_val = 2;
820 break;
821 case 2:
822 field_val = 1;
823 break;
824 case 1:
825 field_val = 0;
826 break;
827 }
828 } else
829 field_val = new_div;
830
831 reg = (void __iomem *)div_sel;
832
833 reg_val = __raw_readl(reg);
834 reg_val &= ~(field_mask << div_off);
835 reg_val |= (field_val << div_off);
836 __raw_writel(reg_val, reg);
837 wmb();
838 clk->rate = clk->parent->rate / field_val;
839
840 if (clk->flags & DELAYED_APP) {
841 __raw_writel(0x1, (void __iomem *)&PRCM_CLKCFG_CTRL);
842 wmb();
843 }
844 ret = 0;
845 } else if (clk->set_rate != 0)
846 ret = clk->set_rate(clk, rate);
847
848 if (unlikely(ret == 0 && (clk->flags & RATE_PROPAGATES)))
849 propagate_rate(clk);
850
851 return ret;
852}
853
854/* Converts encoded control register address into a full address */
855static u32 omap2_get_src_field(u32 *type_to_addr, u32 reg_offset,
856 struct clk *src_clk, u32 *field_mask)
857{
858 u32 val = ~0, src_reg_addr = 0, mask = 0;
859
860 /* Find target control register.*/
861 switch ((*type_to_addr & SRC_RATE_SEL_MASK)) {
862 case CM_CORE_SEL1:
863 src_reg_addr = (u32)&CM_CLKSEL1_CORE;
864 if (reg_offset == 13) { /* DSS2_fclk */
865 mask = 0x1;
866 if (src_clk == &sys_ck)
867 val = 0;
868 if (src_clk == &func_48m_ck)
869 val = 1;
870 } else if (reg_offset == 8) { /* DSS1_fclk */
871 mask = 0x1f;
872 if (src_clk == &sys_ck)
873 val = 0;
874 else if (src_clk == &core_ck) /* divided clock */
875 val = 0x10; /* rate needs fixing */
876 } else if ((reg_offset == 15) && cpu_is_omap2420()){ /*vlnyq*/
877 mask = 0x1F;
878 if(src_clk == &func_96m_ck)
879 val = 0;
880 else if (src_clk == &core_ck)
881 val = 0x10;
882 }
883 break;
884 case CM_CORE_SEL2:
885 src_reg_addr = (u32)&CM_CLKSEL2_CORE;
886 mask = 0x3;
887 if (src_clk == &func_32k_ck)
888 val = 0x0;
889 if (src_clk == &sys_ck)
890 val = 0x1;
891 if (src_clk == &alt_ck)
892 val = 0x2;
893 break;
894 case CM_WKUP_SEL1:
895 src_reg_addr = (u32)&CM_CLKSEL_WKUP;
896 mask = 0x3;
897 if (src_clk == &func_32k_ck)
898 val = 0x0;
899 if (src_clk == &sys_ck)
900 val = 0x1;
901 if (src_clk == &alt_ck)
902 val = 0x2;
903 break;
904 case CM_PLL_SEL1:
905 src_reg_addr = (u32)&CM_CLKSEL1_PLL;
906 mask = 0x1;
907 if (reg_offset == 0x3) {
908 if (src_clk == &apll96_ck)
909 val = 0;
910 if (src_clk == &alt_ck)
911 val = 1;
912 }
913 else if (reg_offset == 0x5) {
914 if (src_clk == &apll54_ck)
915 val = 0;
916 if (src_clk == &alt_ck)
917 val = 1;
918 }
919 break;
920 case CM_PLL_SEL2:
921 src_reg_addr = (u32)&CM_CLKSEL2_PLL;
922 mask = 0x3;
923 if (src_clk == &func_32k_ck)
924 val = 0x0;
925 if (src_clk == &dpll_ck)
926 val = 0x2;
927 break;
928 case CM_SYSCLKOUT_SEL1:
929 src_reg_addr = (u32)&PRCM_CLKOUT_CTRL;
930 mask = 0x3;
931 if (src_clk == &dpll_ck)
932 val = 0;
933 if (src_clk == &sys_ck)
934 val = 1;
935 if (src_clk == &func_96m_ck)
936 val = 2;
937 if (src_clk == &func_54m_ck)
938 val = 3;
939 break;
940 }
941
942 if (val == ~0) /* Catch errors in offset */
943 *type_to_addr = 0;
944 else
945 *type_to_addr = src_reg_addr;
946 *field_mask = mask;
947
948 return val;
949}
950
951static int omap2_clk_set_parent(struct clk *clk, struct clk *new_parent)
952{
953 void __iomem * reg;
954 u32 src_sel, src_off, field_val, field_mask, reg_val, rate;
955 int ret = -EINVAL;
956
957 if (unlikely(clk->flags & CONFIG_PARTICIPANT))
958 return ret;
959
960 if (clk->flags & SRC_SEL_MASK) { /* On-chip SEL collection */
961 src_sel = (SRC_RATE_SEL_MASK & clk->flags);
962 src_off = clk->src_offset;
963
964 if (src_sel == 0)
965 goto set_parent_error;
966
967 field_val = omap2_get_src_field(&src_sel, src_off, new_parent,
968 &field_mask);
969
970 reg = (void __iomem *)src_sel;
971
972 if (clk->usecount > 0)
973 _omap2_clk_disable(clk);
974
975 /* Set new source value (previous dividers if any in effect) */
976 reg_val = __raw_readl(reg) & ~(field_mask << src_off);
977 reg_val |= (field_val << src_off);
978 __raw_writel(reg_val, reg);
979 wmb();
980
981 if (clk->flags & DELAYED_APP) {
982 __raw_writel(0x1, (void __iomem *)&PRCM_CLKCFG_CTRL);
983 wmb();
984 }
985 if (clk->usecount > 0)
986 _omap2_clk_enable(clk);
987
988 clk->parent = new_parent;
989
990 /* SRC_RATE_SEL_MASK clocks follow their parents rates.*/
991 if ((new_parent == &core_ck) && (clk == &dss1_fck))
992 clk->rate = new_parent->rate / 0x10;
993 else
994 clk->rate = new_parent->rate;
995
996 if (unlikely(clk->flags & RATE_PROPAGATES))
997 propagate_rate(clk);
998
999 return 0;
1000 } else {
1001 clk->parent = new_parent;
1002 rate = new_parent->rate;
1003 omap2_clk_set_rate(clk, rate);
1004 ret = 0;
1005 }
1006
1007 set_parent_error:
1008 return ret;
1009}
1010#endif /* OLD_CK */
1011
1012/* Sets basic clocks based on the specified rate */ 310/* Sets basic clocks based on the specified rate */
1013static int omap2_select_table_rate(struct clk *clk, unsigned long rate) 311static int omap2_select_table_rate(struct clk *clk, unsigned long rate)
1014{ 312{
@@ -1090,26 +388,6 @@ static int omap2_select_table_rate(struct clk *clk, unsigned long rate)
1090 return 0; 388 return 0;
1091} 389}
1092 390
1093/*-------------------------------------------------------------------------
1094 * Omap2 clock reset and init functions
1095 *-------------------------------------------------------------------------*/
1096
1097#ifdef CONFIG_OMAP_RESET_CLOCKS
1098static void __init omap2_clk_disable_unused(struct clk *clk)
1099{
1100 u32 regval32;
1101
1102 regval32 = __raw_readl(clk->enable_reg);
1103 if ((regval32 & (1 << clk->enable_bit)) == 0)
1104 return;
1105
1106 printk(KERN_INFO "Disabling unused clock \"%s\"\n", clk->name);
1107 _omap2_clk_disable(clk);
1108}
1109#else
1110#define omap2_clk_disable_unused NULL
1111#endif
1112
1113static struct clk_functions omap2_clk_functions = { 391static struct clk_functions omap2_clk_functions = {
1114 .clk_enable = omap2_clk_enable, 392 .clk_enable = omap2_clk_enable,
1115 .clk_disable = omap2_clk_disable, 393 .clk_disable = omap2_clk_disable,