]> git.kernelconcepts.de Git - karo-tx-uboot.git/blob - arch/arm/cpu/arm926ejs/mxs/spl_mem_init.c
mxs: set vector base address to RAM to be able to use the memabort_handler
[karo-tx-uboot.git] / arch / arm / cpu / arm926ejs / mxs / spl_mem_init.c
1 /*
2  * Freescale i.MX28 RAM init
3  *
4  * Copyright (C) 2011 Marek Vasut <marek.vasut@gmail.com>
5  * on behalf of DENX Software Engineering GmbH
6  *
7  * SPDX-License-Identifier:     GPL-2.0+
8  */
9
10 #include <common.h>
11 #include <config.h>
12 #include <asm/io.h>
13 #include <asm/arch/imx-regs.h>
14 #include <asm/arch/sys_proto.h>
15 #include <linux/compiler.h>
16
17 #include "mxs_init.h"
18
19 static uint32_t dram_vals[] = {
20 /*
21  * i.MX28 DDR2 at 200MHz
22  */
23 #if defined(CONFIG_MX28)
24         0x00000000, 0x00000000, 0x00000000, 0x00000000,
25         0x00000000, 0x00000000, 0x00000000, 0x00000000,
26         0x00000000, 0x00000000, 0x00000000, 0x00000000,
27         0x00000000, 0x00000000, 0x00000000, 0x00000000,
28         0x00000000, 0x00000100, 0x00000000, 0x00000000,
29         0x00000000, 0x00000000, 0x00000000, 0x00000000,
30         0x00000000, 0x00000000, 0x00010101, 0x01010101,
31         0x000f0f01, 0x0f02020a, 0x00000000, 0x00010101,
32         0x00000100, 0x00000100, 0x00000000, 0x00000002,
33         0x01010000, 0x07080403, 0x06005003, 0x0a0000c8,
34         0x02009c40, 0x0002030c, 0x0036a609, 0x031a0612,
35         0x02030202, 0x00c8001c, 0x00000000, 0x00000000,
36         0x00012100, 0xffff0303, 0x00012100, 0xffff0303,
37         0x00012100, 0xffff0303, 0x00012100, 0xffff0303,
38         0x00000003, 0x00000000, 0x00000000, 0x00000000,
39         0x00000000, 0x00000000, 0x00000000, 0x00000000,
40         0x00000000, 0x00000000, 0x00000612, 0x01000F02,
41         0x06120612, 0x00000200, 0x00020007, 0xf4004a27,
42         0xf4004a27, 0xf4004a27, 0xf4004a27, 0x07000300,
43         0x07000300, 0x07400300, 0x07400300, 0x00000005,
44         0x00000000, 0x00000000, 0x01000000, 0x01020408,
45         0x08040201, 0x000f1133, 0x00000000, 0x00001f04,
46         0x00001f04, 0x00001f04, 0x00001f04, 0x00001f04,
47         0x00001f04, 0x00001f04, 0x00001f04, 0x00000000,
48         0x00000000, 0x00000000, 0x00000000, 0x00000000,
49         0x00000000, 0x00000000, 0x00000000, 0x00000000,
50         0x00000000, 0x00000000, 0x00000000, 0x00000000,
51         0x00000000, 0x00000000, 0x00000000, 0x00000000,
52         0x00000000, 0x00000000, 0x00000000, 0x00000000,
53         0x00000000, 0x00000000, 0x00000000, 0x00000000,
54         0x00000000, 0x00000000, 0x00000000, 0x00000000,
55         0x00000000, 0x00000000, 0x00000000, 0x00000000,
56         0x00000000, 0x00000000, 0x00000000, 0x00000000,
57         0x00000000, 0x00000000, 0x00000000, 0x00000000,
58         0x00000000, 0x00000000, 0x00000000, 0x00000000,
59         0x00000000, 0x00000000, 0x00000000, 0x00000000,
60         0x00000000, 0x00000000, 0x00000000, 0x00000000,
61         0x00000000, 0x00000000, 0x00000000, 0x00000000,
62         0x00000000, 0x00000000, 0x00000000, 0x00000000,
63         0x00000000, 0x00000000, 0x00000000, 0x00000000,
64         0x00000000, 0x00000000, 0x00010000, 0x00030404,
65         0x00000003, 0x00000000, 0x00000000, 0x00000000,
66         0x00000000, 0x00000000, 0x00000000, 0x01010000,
67         0x01000000, 0x03030000, 0x00010303, 0x01020202,
68         0x00000000, 0x02040303, 0x21002103, 0x00061200,
69         0x06120612, 0x04420442, 0x04420442, 0x00040004,
70         0x00040004, 0x00000000, 0x00000000, 0x00000000,
71         0x00000000, 0xffffffff
72
73 /*
74  * i.MX23 DDR at 133MHz
75  */
76 #elif defined(CONFIG_MX23)
77         0x01010001, 0x00010100, 0x01000101, 0x00000001,
78         0x00000101, 0x00000000, 0x00010000, 0x01000001,
79         0x00000000, 0x00000001, 0x07000200, 0x00070202,
80         0x02020000, 0x04040a01, 0x00000201, 0x02040000,
81         0x02000000, 0x19000f08, 0x0d0d0000, 0x02021313,
82         0x02061521, 0x0000000a, 0x00080008, 0x00200020,
83         0x00200020, 0x00200020, 0x000003f7, 0x00000000,
84         0x00000000, 0x00000020, 0x00000020, 0x00c80000,
85         0x000a23cd, 0x000000c8, 0x00006665, 0x00000000,
86         0x00000101, 0x00040001, 0x00000000, 0x00000000,
87         0x00010000
88 #else
89 #error Unsupported memory initialization
90 #endif
91 };
92
93 __weak void mxs_adjust_memory_params(uint32_t *dram_vals)
94 {
95 }
96
97 #ifdef CONFIG_MX28
98 static void initialize_dram_values(void)
99 {
100         int i;
101
102         mxs_adjust_memory_params(dram_vals);
103
104         for (i = 0; i < ARRAY_SIZE(dram_vals); i++)
105                 writel(dram_vals[i], MXS_DRAM_BASE + (4 * i));
106 }
107 #else
108 static void initialize_dram_values(void)
109 {
110         int i;
111
112         mxs_adjust_memory_params(dram_vals);
113
114         /*
115          * HW_DRAM_CTL27, HW_DRAM_CTL28 and HW_DRAM_CTL35 are not initialized as
116          * per FSL bootlets code.
117          *
118          * mx23 Reference Manual marks HW_DRAM_CTL27 and HW_DRAM_CTL28 as
119          * "reserved".
120          * HW_DRAM_CTL8 is setup as the last element.
121          * So skip the initialization of these HW_DRAM_CTL registers.
122          */
123         for (i = 0; i < ARRAY_SIZE(dram_vals); i++) {
124                 if (i == 8 || i == 27 || i == 28 || i == 35)
125                         continue;
126                 writel(dram_vals[i], MXS_DRAM_BASE + (4 * i));
127         }
128
129         /*
130          * Enable tRAS lockout in HW_DRAM_CTL08 ; it must be the last
131          * element to be set
132          */
133         writel((1 << 24), MXS_DRAM_BASE + (4 * 8));
134 }
135 #endif
136
137 static void mxs_mem_init_clock(void)
138 {
139         struct mxs_clkctrl_regs *clkctrl_regs =
140                 (struct mxs_clkctrl_regs *)MXS_CLKCTRL_BASE;
141 #if defined(CONFIG_MX23)
142         /* Fractional divider for ref_emi is 33 ; 480 * 18 / 33 = 266MHz */
143         const unsigned char divider = 33;
144 #elif defined(CONFIG_MX28)
145         /* Fractional divider for ref_emi is 21 ; 480 * 18 / 21 = 411MHz */
146         const unsigned char divider = 21;
147 #endif
148
149         /* Gate EMI clock */
150         writeb(CLKCTRL_FRAC_CLKGATE,
151                 &clkctrl_regs->hw_clkctrl_frac0_set[CLKCTRL_FRAC0_EMI]);
152
153         /* Set fractional divider for ref_emi */
154         writeb(CLKCTRL_FRAC_CLKGATE | (divider & CLKCTRL_FRAC_FRAC_MASK),
155                 &clkctrl_regs->hw_clkctrl_frac0[CLKCTRL_FRAC0_EMI]);
156
157         /* Ungate EMI clock */
158         writeb(CLKCTRL_FRAC_CLKGATE,
159                 &clkctrl_regs->hw_clkctrl_frac0_clr[CLKCTRL_FRAC0_EMI]);
160
161
162         /* Set EMI clock divider for EMI clock to 411 / 2 = 205MHz */
163         writel((2 << CLKCTRL_EMI_DIV_EMI_OFFSET) |
164                 (1 << CLKCTRL_EMI_DIV_XTAL_OFFSET),
165                 &clkctrl_regs->hw_clkctrl_emi);
166         while (readl(&clkctrl_regs->hw_clkctrl_emi) & CLKCTRL_EMI_BUSY_REF_EMI)
167                 ;
168
169         /* Unbypass EMI */
170         writel(CLKCTRL_CLKSEQ_BYPASS_EMI,
171                 &clkctrl_regs->hw_clkctrl_clkseq_clr);
172 }
173
174 static void mxs_mem_setup_cpu_and_hbus(void)
175 {
176         struct mxs_clkctrl_regs *clkctrl_regs =
177                 (struct mxs_clkctrl_regs *)MXS_CLKCTRL_BASE;
178
179         /* Set fractional divider for ref_cpu to 480 * 18 / 19 = 454MHz
180          * and ungate CPU clock */
181         writeb(19 & CLKCTRL_FRAC_FRAC_MASK,
182                 (uint8_t *)&clkctrl_regs->hw_clkctrl_frac0[CLKCTRL_FRAC0_CPU]);
183
184         /* Set CPU bypass */
185         writel(CLKCTRL_CLKSEQ_BYPASS_CPU,
186                 &clkctrl_regs->hw_clkctrl_clkseq_set);
187
188         /* HBUS = 151MHz */
189         clrsetbits_le32(&clkctrl_regs->hw_clkctrl_hbus,
190                         CLKCTRL_HBUS_DIV_MASK,
191                         3 << CLKCTRL_HBUS_DIV_OFFSET);
192         while (readl(&clkctrl_regs->hw_clkctrl_hbus) & CLKCTRL_HBUS_ASM_BUSY)
193                 ;
194
195         /* CPU clock divider = 1 */
196         clrsetbits_le32(&clkctrl_regs->hw_clkctrl_cpu,
197                         CLKCTRL_CPU_DIV_CPU_MASK,
198                         1 << CLKCTRL_CPU_DIV_CPU_OFFSET);
199         while (readl(&clkctrl_regs->hw_clkctrl_cpu) & CLKCTRL_CPU_BUSY_REF_CPU)
200                 ;
201
202         /* Disable CPU bypass */
203         writel(CLKCTRL_CLKSEQ_BYPASS_CPU,
204                 &clkctrl_regs->hw_clkctrl_clkseq_clr);
205 }
206
207 void data_abort_memdetect_handler(void)
208 {
209         asm volatile("subs pc, lr, #4");
210 }
211
212 uint32_t mxs_mem_get_size(void)
213 {
214         uint32_t sz, da;
215         uint32_t *vt = (uint32_t *)0x20;
216         unsigned long cr;
217
218         /* move vector table to low memory */
219         asm volatile(
220                 "mrc p15, 0, %0, c1, c0, 0\n"
221                 "bic r7, %0, #(1 << 13)\n"
222                 "mcr p15, 0, r7, c1, c0, 0\n"
223                 : "=r"(cr) : : "r7");
224
225         /* Replace the DABT handler. */
226         da = vt[4];
227         vt[4] = (uint32_t)data_abort_memdetect_handler;
228
229         sz = get_ram_size((long *)PHYS_SDRAM_1, PHYS_SDRAM_1_SIZE);
230
231         /* Restore the old DABT handler. */
232         vt[4] = da;
233         asm volatile("mcr p15, 0, %0, c1, c0, 0\n" : : "r"(cr));
234
235         return sz;
236 }
237
238 #ifdef CONFIG_MX23
239 static void mx23_mem_setup_vddmem(void)
240 {
241         struct mxs_power_regs *power_regs =
242                 (struct mxs_power_regs *)MXS_POWER_BASE;
243
244         clrbits_le32(&power_regs->hw_power_vddmemctrl,
245                 POWER_VDDMEMCTRL_ENABLE_ILIMIT);
246
247 }
248
249 static void mx23_mem_init(void)
250 {
251         /*
252          * Reset/ungate the EMI block. This is essential, otherwise the system
253          * suffers from memory instability. This thing is mx23 specific and is
254          * no longer present on mx28.
255          */
256         mxs_reset_block((struct mxs_register_32 *)MXS_EMI_BASE);
257
258         mx23_mem_setup_vddmem();
259
260         /*
261          * Configure the DRAM registers
262          */
263
264         /* Clear START and SREFRESH bit from DRAM_CTL8 */
265         clrbits_le32(MXS_DRAM_BASE + 0x20, (1 << 16) | (1 << 8));
266
267         initialize_dram_values();
268
269         /* Set START bit in DRAM_CTL8 */
270         setbits_le32(MXS_DRAM_BASE + 0x20, 1 << 16);
271
272         clrbits_le32(MXS_DRAM_BASE + 0x40, 1 << 17);
273         early_delay(20000);
274
275         /* Adjust EMI port priority. */
276         clrsetbits_le32(0x80020000, 0x1f << 16, 0x2);
277         early_delay(20000);
278
279         setbits_le32(MXS_DRAM_BASE + 0x40, 1 << 19);
280         setbits_le32(MXS_DRAM_BASE + 0x40, 1 << 11);
281 }
282 #endif
283
284 #ifdef CONFIG_MX28
285 static void mx28_mem_init(void)
286 {
287         struct mxs_pinctrl_regs *pinctrl_regs =
288                 (struct mxs_pinctrl_regs *)MXS_PINCTRL_BASE;
289
290         /* Set DDR2 mode */
291         writel(PINCTRL_EMI_DS_CTRL_DDR_MODE_DDR2,
292                 &pinctrl_regs->hw_pinctrl_emi_ds_ctrl_set);
293
294         /*
295          * Configure the DRAM registers
296          */
297
298         /* Clear START bit from DRAM_CTL16 */
299         clrbits_le32(MXS_DRAM_BASE + 0x40, 1);
300
301         initialize_dram_values();
302
303         /* Clear SREFRESH bit from DRAM_CTL17 */
304         clrbits_le32(MXS_DRAM_BASE + 0x44, 1);
305
306         /* Set START bit in DRAM_CTL16 */
307         setbits_le32(MXS_DRAM_BASE + 0x40, 1);
308
309         /* Wait for bit 20 (DRAM init complete) in DRAM_CTL58 */
310         while (!(readl(MXS_DRAM_BASE + 0xe8) & (1 << 20)))
311                 ;
312 }
313 #endif
314
315 void mxs_mem_init(void)
316 {
317         early_delay(11000);
318
319         mxs_mem_init_clock();
320
321 #if defined(CONFIG_MX23)
322         mx23_mem_init();
323 #elif defined(CONFIG_MX28)
324         mx28_mem_init();
325 #endif
326
327         mxs_mem_setup_cpu_and_hbus();
328 }