1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25#include <common.h>
26#include <asm/processor.h>
27
28#include <asm/immap.h>
29
30DECLARE_GLOBAL_DATA_PTR;
31
32
33
34
35#define CLOCK_LPD_MIN (1 << 0)
36#define CLOCK_LPD_MAX (1 << 15)
37
38#define CLOCK_PLL_FVCO_MAX 540000000
39#define CLOCK_PLL_FVCO_MIN 300000000
40
41#define CLOCK_PLL_FSYS_MAX 266666666
42#define CLOCK_PLL_FSYS_MIN 100000000
43#define MHZ 1000000
44
45void clock_enter_limp(int lpdiv)
46{
47 volatile ccm_t *ccm = (volatile ccm_t *)MMAP_CCM;
48 int i, j;
49
50
51 if (lpdiv < CLOCK_LPD_MIN)
52 lpdiv = CLOCK_LPD_MIN;
53 if (lpdiv > CLOCK_LPD_MAX)
54 lpdiv = CLOCK_LPD_MAX;
55
56
57 for (i = 0, j = lpdiv; j != 1; j >>= 1, i++) ;
58
59
60 ccm->cdr = (ccm->cdr & 0xF0FF) | CCM_CDR_LPDIV(i);
61
62
63 ccm->misccr |= CCM_MISCCR_LIMP;
64}
65
66
67
68
69
70void clock_exit_limp(void)
71{
72 volatile ccm_t *ccm = (volatile ccm_t *)MMAP_CCM;
73 volatile pll_t *pll = (volatile pll_t *)MMAP_PLL;
74
75
76 ccm->misccr &= ~CCM_MISCCR_LIMP;
77
78
79 while (!(pll->psr & PLL_PSR_LOCK)) ;
80}
81
82
83
84
85int get_clocks(void)
86{
87
88 volatile ccm_t *ccm = (volatile ccm_t *)MMAP_CCM;
89 volatile pll_t *pll = (volatile pll_t *)MMAP_PLL;
90 int pllmult_nopci[] = { 20, 10, 24, 18, 12, 6, 16, 8 };
91 int pllmult_pci[] = { 12, 6, 16, 8 };
92 int vco = 0, bPci, temp, fbtemp, pcrvalue;
93 int *pPllmult = NULL;
94 u16 fbpll_mask;
95
96#ifdef CONFIG_M54455EVB
97 volatile u8 *cpld = (volatile u8 *)(CONFIG_SYS_CS2_BASE + 3);
98#endif
99 u8 bootmode;
100
101
102 if (((ccm->ccr & CCM_CCR_360_FBCONFIG_MASK) == 0x00e0) ||
103 ((ccm->ccr & CCM_CCR_360_FBCONFIG_MASK) == 0x0060)) {
104 pPllmult = &pllmult_pci[0];
105 fbpll_mask = 3;
106 bPci = 1;
107 } else {
108 pPllmult = &pllmult_nopci[0];
109 fbpll_mask = 7;
110#ifdef CONFIG_PCI
111 gd->pci_clk = 0;
112#endif
113 bPci = 0;
114 }
115
116#ifdef CONFIG_M54455EVB
117 bootmode = (*cpld & 0x03);
118
119 if (bootmode != 3) {
120
121
122 fbtemp = pPllmult[ccm->ccr & fbpll_mask];
123
124
125 pcrvalue = pll->pcr & 0xFFFFF0FF;
126 temp = fbtemp - 1;
127 pcrvalue |= PLL_PCR_OUTDIV3(temp);
128
129 pll->pcr = pcrvalue;
130 }
131#endif
132#ifdef CONFIG_M54451EVB
133
134#ifdef CONFIG_CF_SBF
135 bootmode = 3;
136#else
137 bootmode = 2;
138
139
140 pcrvalue = (pll->pcr & 0x00FFFFFF) | 0x14000000;
141 pll->pcr = pcrvalue;
142 while ((pll->psr & PLL_PSR_LOCK) != PLL_PSR_LOCK);
143#endif
144#endif
145
146 if (bootmode == 0) {
147
148 vco = pPllmult[ccm->rcon & fbpll_mask] * CONFIG_SYS_INPUT_CLKSRC;
149
150 if ((vco < CLOCK_PLL_FVCO_MIN) || (vco > CLOCK_PLL_FVCO_MAX)) {
151
152 int temp = ((pll->pcr & PLL_PCR_OUTDIV2_MASK) >> 4) + 1;
153 int i, j, bus;
154
155 j = (pll->pcr & 0xFF000000) >> 24;
156 for (i = j; i < 0xFF; i++) {
157 vco = i * CONFIG_SYS_INPUT_CLKSRC;
158 if (vco >= CLOCK_PLL_FVCO_MIN) {
159 bus = vco / temp;
160 if (bus <= CLOCK_PLL_FSYS_MIN - MHZ)
161 continue;
162 else
163 break;
164 }
165 }
166 pcrvalue = pll->pcr & 0x00FF00FF;
167 fbtemp = ((i - 1) << 8) | ((i - 1) << 12);
168 pcrvalue |= ((i << 24) | fbtemp);
169
170 pll->pcr = pcrvalue;
171 }
172 gd->vco_clk = vco;
173 } else if (bootmode == 2) {
174
175 vco = ((pll->pcr & 0xFF000000) >> 24) * CONFIG_SYS_INPUT_CLKSRC;
176 if ((vco < CLOCK_PLL_FVCO_MIN) || (vco > CLOCK_PLL_FVCO_MAX)) {
177
178 pcrvalue = (pll->pcr & 0x00FFFFFF);
179 pcrvalue |= pPllmult[ccm->ccr & fbpll_mask] << 24;
180 pll->pcr = pcrvalue;
181 vco = ((pll->pcr & 0xFF000000) >> 24) * CONFIG_SYS_INPUT_CLKSRC;
182 }
183 gd->vco_clk = vco;
184 } else if (bootmode == 3) {
185
186 vco = ((pll->pcr & 0xFF000000) >> 24) * CONFIG_SYS_INPUT_CLKSRC;
187 gd->vco_clk = vco;
188 }
189
190 if ((ccm->ccr & CCM_MISCCR_LIMP) == CCM_MISCCR_LIMP) {
191
192 } else {
193 gd->inp_clk = CONFIG_SYS_INPUT_CLKSRC;
194
195 temp = (pll->pcr & PLL_PCR_OUTDIV1_MASK) + 1;
196 gd->cpu_clk = vco / temp;
197
198 temp = ((pll->pcr & PLL_PCR_OUTDIV2_MASK) >> 4) + 1;
199 gd->bus_clk = vco / temp;
200
201 temp = ((pll->pcr & PLL_PCR_OUTDIV3_MASK) >> 8) + 1;
202 gd->flb_clk = vco / temp;
203
204#ifdef CONFIG_PCI
205 if (bPci) {
206 temp = ((pll->pcr & PLL_PCR_OUTDIV4_MASK) >> 12) + 1;
207 gd->pci_clk = vco / temp;
208 }
209#endif
210 }
211
212#ifdef CONFIG_FSL_I2C
213 gd->i2c1_clk = gd->bus_clk;
214#endif
215
216 return (0);
217}
218