]>
git.proxmox.com Git - mirror_ubuntu-artful-kernel.git/blob - arch/powerpc/boot/pq2.c
f6d118558f1d3ef1b723f9eb1a4359bb3dddc05b
2 * PowerQUICC II support functions
4 * Author: Scott Wood <scottwood@freescale.com>
6 * Copyright (c) 2007 Freescale Semiconductor, Inc.
8 * This program is free software; you can redistribute it and/or modify it
9 * under the terms of the GNU General Public License version 2 as published
10 * by the Free Software Foundation.
20 #define PQ2_SCCR (0x10c80/4) /* System Clock Configuration Register */
21 #define PQ2_SCMR (0x10c88/4) /* System Clock Mode Register */
23 static int pq2_corecnf_map
[] = {
24 3, 2, 2, 2, 4, 4, 5, 9, 6, 11, 8, 10, 3, 12, 7, -1,
25 6, 5, 13, 2, 14, 4, 15, 9, 0, 11, 8, 10, 16, 12, 7, -1
28 /* Get various clocks from crystal frequency.
29 * Returns zero on failure and non-zero on success.
31 int pq2_get_clocks(u32 crystal
, u32
*sysfreq
, u32
*corefreq
,
32 u32
*timebase
, u32
*brgfreq
)
35 u32 sccr
, scmr
, mainclk
, busclk
;
36 int corecnf
, busdf
, plldf
, pllmf
, dfbrg
;
38 immr
= fsl_get_immr();
40 printf("pq2_get_clocks: Couldn't get IMMR base.\r\n");
44 sccr
= in_be32(&immr
[PQ2_SCCR
]);
45 scmr
= in_be32(&immr
[PQ2_SCMR
]);
48 corecnf
= (scmr
>> 24) & 0x1f;
49 busdf
= (scmr
>> 20) & 0xf;
50 plldf
= (scmr
>> 12) & 1;
53 mainclk
= crystal
* (pllmf
+ 1) / (plldf
+ 1);
54 busclk
= mainclk
/ (busdf
+ 1);
57 *sysfreq
= mainclk
/ 2;
59 *timebase
= busclk
/ 4;
61 *brgfreq
= mainclk
/ (1 << ((dfbrg
+ 1) * 2));
64 int coremult
= pq2_corecnf_map
[corecnf
];
67 *corefreq
= mainclk
/ 2;
68 else if (coremult
== 0)
71 *corefreq
= busclk
* coremult
/ 2;
77 /* Set common device tree fields based on the given clock frequencies. */
78 void pq2_set_clocks(u32 sysfreq
, u32 corefreq
, u32 timebase
, u32 brgfreq
)
82 dt_fixup_cpu_clocks(corefreq
, timebase
, sysfreq
);
84 node
= finddevice("/soc/cpm");
86 setprop(node
, "clock-frequency", &sysfreq
, 4);
88 node
= finddevice("/soc/cpm/brg");
90 setprop(node
, "clock-frequency", &brgfreq
, 4);
93 int pq2_fixup_clocks(u32 crystal
)
95 u32 sysfreq
, corefreq
, timebase
, brgfreq
;
97 if (!pq2_get_clocks(crystal
, &sysfreq
, &corefreq
, &timebase
, &brgfreq
))
100 pq2_set_clocks(sysfreq
, corefreq
, timebase
, brgfreq
);