Gitiles
Code Review Sign In
gerrit.devboardsforandroid.linaro.org / platform / external / u-boot / 65cc0e2a65d2c9f107b2f42db6396d9ade6c5ad8 / . / arch / m68k / cpu / mcf5445x / start.S
blob: a083c3d45d277ee552e859cd732de4aab2491578 [file] [log] [blame]
Tom Rini83d290c2018-05-06 17:58:06 -0400[diff] [blame]1/* SPDX-License-Identifier: GPL-2.0+ */
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]2/*
3 * Copyright (C) 2003 Josef Baumgartner <josef.baumgartner@telex.de>
4 * Based on code from Bernhard Kuhn <bkuhn@metrowerks.com>
5 *
Alison Wang45370e12012-10-18 19:25:51 +0000[diff] [blame]6 * Copyright 2010-2012 Freescale Semiconductor, Inc.
7 * TsiChung Liew (Tsi-Chung.Liew@freescale.com)
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]8 */
9
Alison Wang45370e12012-10-18 19:25:51 +0000[diff] [blame]10#include <common.h>
Wolfgang Denk25ddd1f2010-10-26 14:34:52 +0200[diff] [blame]11#include <asm-offsets.h>
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]12#include <config.h>
TsiChung Liewdd9f0542010-03-11 22:12:53 -0600[diff] [blame]13#include <asm/cache.h>
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]14
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]15#define _START _start
16#define _FAULT _fault
17
18#define SAVE_ALL \
19 move.w #0x2700,%sr; /* disable intrs */ \
20 subl #60,%sp; /* space for 15 regs */ \
21 moveml %d0-%d7/%a0-%a6,%sp@;
22
23#define RESTORE_ALL \
24 moveml %sp@,%d0-%d7/%a0-%a6; \
25 addl #60,%sp; /* space for 15 regs */ \
26 rte;
27
Alison Wang45370e12012-10-18 19:25:51 +0000[diff] [blame]28#if defined(CONFIG_SERIAL_BOOT)
Simon Glass98463902022-10-20 18:22:39 -0600[diff] [blame]29#define ASM_DRAMINIT (asm_dram_init - CONFIG_TEXT_BASE + \
Tom Rini65cc0e22022-11-16 13:10:41 -0500[diff] [blame^]30 CFG_SYS_INIT_RAM_ADDR)
Simon Glass98463902022-10-20 18:22:39 -0600[diff] [blame]31#define ASM_DRAMINIT_N (asm_dram_init - CONFIG_TEXT_BASE)
32#define ASM_SBF_IMG_HDR (asm_sbf_img_hdr - CONFIG_TEXT_BASE + \
Tom Rini65cc0e22022-11-16 13:10:41 -0500[diff] [blame^]33 CFG_SYS_INIT_RAM_ADDR)
TsiChung Liew9f751552008-07-23 20:38:53 -0500[diff] [blame]34#endif
35
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]36.text
TsiChung Liew9f751552008-07-23 20:38:53 -0500[diff] [blame]37
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]38/*
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]39 * Vector table. This is used for initial platform startup.
40 * These vectors are to catch any un-intended traps.
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]41 */
42_vectors:
Alison Wang45370e12012-10-18 19:25:51 +0000[diff] [blame]43#if defined(CONFIG_SERIAL_BOOT)
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]44
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]45INITSP: .long 0 /* Initial SP */
Alison Wang45370e12012-10-18 19:25:51 +0000[diff] [blame]46#ifdef CONFIG_CF_SBF
Wolfgang Denk0cf207e2021-09-27 17:42:39 +0200[diff] [blame]47INITPC: .long ASM_DRAMINIT /* Initial PC */
Alison Wang45370e12012-10-18 19:25:51 +0000[diff] [blame]48#endif
49#ifdef CONFIG_SYS_NAND_BOOT
Wolfgang Denk0cf207e2021-09-27 17:42:39 +0200[diff] [blame]50INITPC: .long ASM_DRAMINIT_N /* Initial PC */
Alison Wang45370e12012-10-18 19:25:51 +0000[diff] [blame]51#endif
TsiChung Liew9f751552008-07-23 20:38:53 -0500[diff] [blame]52
53#else
54
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]55INITSP: .long 0 /* Initial SP */
Wolfgang Denk0cf207e2021-09-27 17:42:39 +0200[diff] [blame]56INITPC: .long _START /* Initial PC */
TsiChung Liew9f751552008-07-23 20:38:53 -0500[diff] [blame]57
58#endif
59
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]60vector02_0F:
61.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
62.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]63
64/* Reserved */
65vector10_17:
66.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
67
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]68vector18_1F:
69.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]70
Alison Wang45370e12012-10-18 19:25:51 +0000[diff] [blame]71#if !defined(CONFIG_SERIAL_BOOT)
TsiChung Liew9f751552008-07-23 20:38:53 -0500[diff] [blame]72
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]73/* TRAP #0 - #15 */
74vector20_2F:
75.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
76.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
77
78/* Reserved */
79vector30_3F:
80.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
81.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
82
83vector64_127:
84.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
85.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
86.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
87.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
88.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
89.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
90.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
91.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
92
93vector128_191:
94.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
95.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
96.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
97.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
98.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
99.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
100.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
101.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
102
103vector192_255:
104.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
105.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
106.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
107.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
108.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
109.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
110.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
111.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
TsiChung Liew9f751552008-07-23 20:38:53 -0500[diff] [blame]112#endif
113
Alison Wang45370e12012-10-18 19:25:51 +0000[diff] [blame]114#if defined(CONFIG_SERIAL_BOOT)
TsiChung Liew9f751552008-07-23 20:38:53 -0500[diff] [blame]115 /* Image header: chksum 4 bytes, len 4 bytes, img dest 4 bytes */
116asm_sbf_img_hdr:
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]117 .long 0x00000000 /* checksum, not yet implemented */
118 .long 0x00040000 /* image length */
Simon Glass98463902022-10-20 18:22:39 -0600[diff] [blame]119 .long CONFIG_TEXT_BASE /* image to be relocated at */
TsiChung Liew9f751552008-07-23 20:38:53 -0500[diff] [blame]120
121asm_dram_init:
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]122 move.w #0x2700,%sr /* Mask off Interrupt */
TsiChung Liew709b3842009-06-11 15:39:57 +0000[diff] [blame]123
Alison Wang45370e12012-10-18 19:25:51 +0000[diff] [blame]124#ifdef CONFIG_SYS_NAND_BOOT
125 /* for assembly stack */
Tom Rini65cc0e22022-11-16 13:10:41 -0500[diff] [blame^]126 move.l #(CFG_SYS_INIT_RAM_ADDR + CFG_SYS_INIT_RAM_CTRL), %d0
Alison Wang45370e12012-10-18 19:25:51 +0000[diff] [blame]127 movec %d0, %RAMBAR1
128
Tom Rini65cc0e22022-11-16 13:10:41 -0500[diff] [blame^]129 move.l #(CFG_SYS_INIT_RAM_ADDR + CFG_SYS_INIT_SP_OFFSET), %sp
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]130 clr.l %sp@-
Alison Wang45370e12012-10-18 19:25:51 +0000[diff] [blame]131#endif
132
133#ifdef CONFIG_CF_SBF
Tom Rini65cc0e22022-11-16 13:10:41 -0500[diff] [blame^]134 move.l #CFG_SYS_INIT_RAM_ADDR, %d0
TsiChung Liew709b3842009-06-11 15:39:57 +0000[diff] [blame]135 movec %d0, %VBR
136
Tom Rini65cc0e22022-11-16 13:10:41 -0500[diff] [blame^]137 move.l #(CFG_SYS_INIT_RAM_ADDR + CFG_SYS_INIT_RAM_CTRL), %d0
TsiChung Liew709b3842009-06-11 15:39:57 +0000[diff] [blame]138 movec %d0, %RAMBAR1
139
140 /* initialize general use internal ram */
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]141 move.l #0, %d0
142 move.l #(ICACHE_STATUS), %a1 /* icache */
143 move.l #(DCACHE_STATUS), %a2 /* dcache */
144 move.l %d0, (%a1)
145 move.l %d0, (%a2)
TsiChung Liew709b3842009-06-11 15:39:57 +0000[diff] [blame]146
147 /* invalidate and disable cache */
Tom Rini65cc0e22022-11-16 13:10:41 -0500[diff] [blame^]148 move.l #(CFG_SYS_ICACHE_INV + CFG_SYS_DCACHE_INV), %d0
TsiChung Liew709b3842009-06-11 15:39:57 +0000[diff] [blame]149 movec %d0, %CACR /* Invalidate cache */
150 move.l #0, %d0
151 movec %d0, %ACR0
152 movec %d0, %ACR1
153 movec %d0, %ACR2
154 movec %d0, %ACR3
155
Tom Rini65cc0e22022-11-16 13:10:41 -0500[diff] [blame^]156 move.l #(CFG_SYS_INIT_RAM_ADDR + CFG_SYS_INIT_SP_OFFSET), %sp
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]157 clr.l %sp@-
TsiChung Liew9f751552008-07-23 20:38:53 -0500[diff] [blame]158
Tom Rini65cc0e22022-11-16 13:10:41 -0500[diff] [blame^]159#ifdef CFG_SYS_CS0_BASE
TsiChung Liew9f751552008-07-23 20:38:53 -0500[diff] [blame]160 /* Must disable global address */
161 move.l #0xFC008000, %a1
Tom Rini65cc0e22022-11-16 13:10:41 -0500[diff] [blame^]162 move.l #(CFG_SYS_CS0_BASE), (%a1)
TsiChung Liew9f751552008-07-23 20:38:53 -0500[diff] [blame]163 move.l #0xFC008008, %a1
Tom Rini65cc0e22022-11-16 13:10:41 -0500[diff] [blame^]164 move.l #(CFG_SYS_CS0_CTRL), (%a1)
TsiChung Liew9f751552008-07-23 20:38:53 -0500[diff] [blame]165 move.l #0xFC008004, %a1
Tom Rini65cc0e22022-11-16 13:10:41 -0500[diff] [blame^]166 move.l #(CFG_SYS_CS0_MASK), (%a1)
Angelo Dureghello02a6edd2017-05-15 00:17:48 +0200[diff] [blame]167#endif
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]168#endif /* CONFIG_CF_SBF */
TsiChung Liew9f751552008-07-23 20:38:53 -0500[diff] [blame]169
Alison Wang45370e12012-10-18 19:25:51 +0000[diff] [blame]170#ifdef CONFIG_MCF5441x
171 /* TC: enable all peripherals,
172 in the future only enable certain peripherals */
173 move.l #0xFC04002D, %a1
174
175#if defined(CONFIG_CF_SBF)
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]176 move.b #23, (%a1) /* dspi */
Alison Wang45370e12012-10-18 19:25:51 +0000[diff] [blame]177#endif
Angelo Dureghelloc74dda82017-05-14 21:42:27 +0200[diff] [blame]178#endif /* CONFIG_MCF5441x */
Alison Wang45370e12012-10-18 19:25:51 +0000[diff] [blame]179
Angelo Dureghelloc74dda82017-05-14 21:42:27 +0200[diff] [blame]180 /* mandatory board level ddr-sdram init,
181 * for both 5441x and 5445x
182 */
183 bsr sbf_dram_init
TsiChung Liew709b3842009-06-11 15:39:57 +0000[diff] [blame]184
Alison Wang45370e12012-10-18 19:25:51 +0000[diff] [blame]185#ifdef CONFIG_CF_SBF
TsiChung Liew9f751552008-07-23 20:38:53 -0500[diff] [blame]186 /*
187 * DSPI Initialization
188 * a0 - general, sram - 0x80008000 - 32, see M54455EVB.h
189 * a1 - dspi status
190 * a2 - dtfr
191 * a3 - drfr
192 * a4 - Dst addr
193 */
194 /* Enable pins for DSPI mode - chip-selects are enabled later */
TsiChung Liew709b3842009-06-11 15:39:57 +0000[diff] [blame]195asm_dspi_init:
Alison Wang45370e12012-10-18 19:25:51 +0000[diff] [blame]196#ifdef CONFIG_MCF5441x
197 move.l #0xEC09404E, %a1
198 move.l #0xEC09404F, %a2
199 move.b #0xFF, (%a1)
200 move.b #0x80, (%a2)
201#endif
202
TsiChung Liew9f751552008-07-23 20:38:53 -0500[diff] [blame]203 /* Configure DSPI module */
204 move.l #0xFC05C000, %a0
205 move.l #0x80FF0C00, (%a0) /* Master, clear TX/RX FIFO */
206
207 move.l #0xFC05C00C, %a0
Alison Wang45370e12012-10-18 19:25:51 +0000[diff] [blame]208#ifdef CONFIG_MCF5441x
209 move.l #0x3E000016, (%a0)
210#endif
TsiChung Liew9f751552008-07-23 20:38:53 -0500[diff] [blame]211
212 move.l #0xFC05C034, %a2 /* dtfr */
213 move.l #0xFC05C03B, %a3 /* drfr */
214
215 move.l #(ASM_SBF_IMG_HDR + 4), %a1
216 move.l (%a1)+, %d5
217 move.l (%a1), %a4
218
Tom Rini65cc0e22022-11-16 13:10:41 -0500[diff] [blame^]219 move.l #(CFG_SYS_INIT_RAM_ADDR + CFG_SYS_SBFHDR_DATA_OFFSET), %a0
220 move.l #(CFG_SYS_SBFHDR_SIZE), %d4
TsiChung Liew9f751552008-07-23 20:38:53 -0500[diff] [blame]221
222 move.l #0xFC05C02C, %a1 /* dspi status */
223
224 /* Issue commands and address */
225 move.l #0x8002000B, %d2 /* Fast Read Cmd */
226 jsr asm_dspi_wr_status
227 jsr asm_dspi_rd_status
228
229 move.l #0x80020000, %d2 /* Address byte 2 */
230 jsr asm_dspi_wr_status
231 jsr asm_dspi_rd_status
232
233 move.l #0x80020000, %d2 /* Address byte 1 */
234 jsr asm_dspi_wr_status
235 jsr asm_dspi_rd_status
236
237 move.l #0x80020000, %d2 /* Address byte 0 */
238 jsr asm_dspi_wr_status
239 jsr asm_dspi_rd_status
240
241 move.l #0x80020000, %d2 /* Dummy Wr and Rd */
242 jsr asm_dspi_wr_status
243 jsr asm_dspi_rd_status
244
245 /* Transfer serial boot header to sram */
246asm_dspi_rd_loop1:
247 move.l #0x80020000, %d2
248 jsr asm_dspi_wr_status
249 jsr asm_dspi_rd_status
250
251 move.b %d1, (%a0) /* read, copy to dst */
252
253 add.l #1, %a0 /* inc dst by 1 */
254 sub.l #1, %d4 /* dec cnt by 1 */
255 bne asm_dspi_rd_loop1
256
257 /* Transfer u-boot from serial flash to memory */
258asm_dspi_rd_loop2:
259 move.l #0x80020000, %d2
260 jsr asm_dspi_wr_status
261 jsr asm_dspi_rd_status
262
263 move.b %d1, (%a4) /* read, copy to dst */
264
265 add.l #1, %a4 /* inc dst by 1 */
266 sub.l #1, %d5 /* dec cnt by 1 */
267 bne asm_dspi_rd_loop2
268
269 move.l #0x00020000, %d2 /* Terminate */
270 jsr asm_dspi_wr_status
271 jsr asm_dspi_rd_status
272
273 /* jump to memory and execute */
Simon Glass98463902022-10-20 18:22:39 -0600[diff] [blame]274 move.l #(CONFIG_TEXT_BASE + 0x400), %a0
TsiChung Liew9f751552008-07-23 20:38:53 -0500[diff] [blame]275 jmp (%a0)
276
277asm_dspi_wr_status:
278 move.l (%a1), %d0 /* status */
279 and.l #0x0000F000, %d0
280 cmp.l #0x00003000, %d0
281 bgt asm_dspi_wr_status
282
283 move.l %d2, (%a2)
284 rts
285
286asm_dspi_rd_status:
287 move.l (%a1), %d0 /* status */
288 and.l #0x000000F0, %d0
289 lsr.l #4, %d0
290 cmp.l #0, %d0
291 beq asm_dspi_rd_status
292
293 move.b (%a3), %d1
294 rts
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]295#endif /* CONFIG_CF_SBF */
Alison Wang45370e12012-10-18 19:25:51 +0000[diff] [blame]296
297#ifdef CONFIG_SYS_NAND_BOOT
298 /* copy 4 boot pages to dram as soon as possible */
299 /* each page is 996 bytes (1056 total with 60 ECC bytes */
300 move.l #0x00000000, %a1 /* src */
Simon Glass98463902022-10-20 18:22:39 -0600[diff] [blame]301 move.l #CONFIG_TEXT_BASE, %a2 /* dst */
Alison Wang45370e12012-10-18 19:25:51 +0000[diff] [blame]302 move.l #0x3E0, %d0 /* sz in long */
303
304asm_boot_nand_copy:
305 move.l (%a1)+, (%a2)+
306 subq.l #1, %d0
307 bne asm_boot_nand_copy
308
309 /* jump to memory and execute */
310 move.l #(asm_nand_init), %a0
311 jmp (%a0)
312
313asm_nand_init:
314 /* exit nand boot-mode */
315 move.l #0xFC0FFF30, %a1
316 or.l #0x00000040, %d1
317 move.l %d1, (%a1)
318
319 /* initialize general use internal ram */
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]320 move.l #0, %d0
321 move.l #(CACR_STATUS), %a1 /* CACR */
322 move.l #(ICACHE_STATUS), %a2 /* icache */
323 move.l #(DCACHE_STATUS), %a3 /* dcache */
324 move.l %d0, (%a1)
325 move.l %d0, (%a2)
326 move.l %d0, (%a3)
Alison Wang45370e12012-10-18 19:25:51 +0000[diff] [blame]327
328 /* invalidate and disable cache */
329 move.l #0x01004100, %d0 /* Invalidate cache cmd */
330 movec %d0, %CACR /* Invalidate cache */
331 move.l #0, %d0
332 movec %d0, %ACR0
333 movec %d0, %ACR1
334 movec %d0, %ACR2
335 movec %d0, %ACR3
336
Tom Rini65cc0e22022-11-16 13:10:41 -0500[diff] [blame^]337#ifdef CFG_SYS_CS0_BASE
Alison Wang45370e12012-10-18 19:25:51 +0000[diff] [blame]338 /* Must disable global address */
339 move.l #0xFC008000, %a1
Tom Rini65cc0e22022-11-16 13:10:41 -0500[diff] [blame^]340 move.l #(CFG_SYS_CS0_BASE), (%a1)
Alison Wang45370e12012-10-18 19:25:51 +0000[diff] [blame]341 move.l #0xFC008008, %a1
Tom Rini65cc0e22022-11-16 13:10:41 -0500[diff] [blame^]342 move.l #(CFG_SYS_CS0_CTRL), (%a1)
Alison Wang45370e12012-10-18 19:25:51 +0000[diff] [blame]343 move.l #0xFC008004, %a1
Tom Rini65cc0e22022-11-16 13:10:41 -0500[diff] [blame^]344 move.l #(CFG_SYS_CS0_MASK), (%a1)
Angelo Dureghello02a6edd2017-05-15 00:17:48 +0200[diff] [blame]345#endif
Alison Wang45370e12012-10-18 19:25:51 +0000[diff] [blame]346
347 /* NAND port configuration */
348 move.l #0xEC094048, %a1
349 move.b #0xFD, (%a1)+
350 move.b #0x5F, (%a1)+
351 move.b #0x04, (%a1)+
352
353 /* reset nand */
354 move.l #0xFC0FFF38, %a1 /* isr */
355 move.l #0x000e0000, (%a1)
356 move.l #0xFC0FFF08, %a2
357 move.l #0x00000000, (%a2)+ /* car */
358 move.l #0x11000000, (%a2)+ /* rar */
359 move.l #0x00000000, (%a2)+ /* rpt */
360 move.l #0x00000000, (%a2)+ /* rai */
361 move.l #0xFC0FFF2c, %a2 /* cfg */
362 move.l #0x00000000, (%a2)+ /* secsz */
363 move.l #0x000e0681, (%a2)+
364 move.l #0xFC0FFF04, %a2 /* cmd2 */
365 move.l #0xFF404001, (%a2)
366 move.l #0x000e0000, (%a1)
367
368 move.l #0x2000, %d1
Angelo Dureghelloc74dda82017-05-14 21:42:27 +0200[diff] [blame]369 bsr asm_delay
Alison Wang45370e12012-10-18 19:25:51 +0000[diff] [blame]370
371 /* setup nand */
372 move.l #0xFC0FFF00, %a1
373 move.l #0x30700000, (%a1)+ /* cmd1 */
374 move.l #0x007EF000, (%a1)+ /* cmd2 */
375
376 move.l #0xFC0FFF2C, %a1
377 move.l #0x00000841, (%a1)+ /* secsz */
378 move.l #0x000e0681, (%a1)+ /* cfg */
379
380 move.l #100, %d4 /* 100 pages ~200KB */
381 move.l #4, %d2 /* start at 4 */
382 move.l #0xFC0FFF04, %a0 /* cmd2 */
383 move.l #0xFC0FFF0C, %a1 /* rar */
Simon Glass98463902022-10-20 18:22:39 -0600[diff] [blame]384 move.l #(CONFIG_TEXT_BASE + 0xF80), %a2
Alison Wang45370e12012-10-18 19:25:51 +0000[diff] [blame]385
386asm_nand_read:
387 move.l #0x11000000, %d0 /* rar */
388 or.l %d2, %d0
389 move.l %d0, (%a1)
390 add.l #1, %d2
391
392 move.l (%a0), %d0 /* cmd2 */
393 or.l #1, %d0
394 move.l %d0, (%a0)
395
396 move.l #0x200, %d1
Angelo Dureghelloc74dda82017-05-14 21:42:27 +0200[diff] [blame]397 bsr asm_delay
Alison Wang45370e12012-10-18 19:25:51 +0000[diff] [blame]398
399asm_nand_chk_status:
400 move.l #0xFC0FFF38, %a4 /* isr */
401 move.l (%a4), %d0
402 and.l #0x40000000, %d0
403 tst.l %d0
404 beq asm_nand_chk_status
405
406 move.l #0xFC0FFF38, %a4 /* isr */
407 move.l (%a4), %d0
408 or.l #0x000E0000, %d0
409 move.l %d0, (%a4)
410
411 move.l #0x200, %d3
412 move.l #0xFC0FC000, %a3 /* buf 1 */
413asm_nand_copy:
414 move.l (%a3)+, (%a2)+
415 subq.l #1, %d3
416 bgt asm_nand_copy
417
418 subq.l #1, %d4
419 bgt asm_nand_read
420
421 /* jump to memory and execute */
Simon Glass98463902022-10-20 18:22:39 -0600[diff] [blame]422 move.l #(CONFIG_TEXT_BASE + 0x400), %a0
Alison Wang45370e12012-10-18 19:25:51 +0000[diff] [blame]423 jmp (%a0)
424
425#endif /* CONFIG_SYS_NAND_BOOT */
TsiChung Liew709b3842009-06-11 15:39:57 +0000[diff] [blame]426
Angelo Dureghelloc74dda82017-05-14 21:42:27 +0200[diff] [blame]427.globl asm_delay
TsiChung Liew709b3842009-06-11 15:39:57 +0000[diff] [blame]428asm_delay:
429 nop
430 subq.l #1, %d1
431 bne asm_delay
432 rts
Alison Wang45370e12012-10-18 19:25:51 +0000[diff] [blame]433#endif /* CONFIG_CF_SBF || CONFIG_NAND_U_BOOT */
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]434
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]435.text
TsiChung Liew9f751552008-07-23 20:38:53 -0500[diff] [blame]436 . = 0x400
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]437.globl _start
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]438_start:
Alison Wang45370e12012-10-18 19:25:51 +0000[diff] [blame]439#if !defined(CONFIG_SERIAL_BOOT)
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]440 nop
441 nop
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]442 move.w #0x2700,%sr /* Mask off Interrupt */
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]443
444 /* Set vector base register at the beginning of the Flash */
Tom Rini65cc0e22022-11-16 13:10:41 -0500[diff] [blame^]445 move.l #CFG_SYS_FLASH_BASE, %d0
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]446 movec %d0, %VBR
447
Tom Rini65cc0e22022-11-16 13:10:41 -0500[diff] [blame^]448 move.l #(CFG_SYS_INIT_RAM_ADDR + CFG_SYS_INIT_RAM_CTRL), %d0
TsiChungLiew225a24b2007-11-07 18:00:54 -0600[diff] [blame]449 movec %d0, %RAMBAR1
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]450
451 /* initialize general use internal ram */
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]452 move.l #0, %d0
453 move.l #(ICACHE_STATUS), %a1 /* icache */
454 move.l #(DCACHE_STATUS), %a2 /* dcache */
455 move.l %d0, (%a1)
456 move.l %d0, (%a2)
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]457
458 /* invalidate and disable cache */
Tom Rini65cc0e22022-11-16 13:10:41 -0500[diff] [blame^]459 move.l #(CFG_SYS_ICACHE_INV + CFG_SYS_DCACHE_INV), %d0
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]460 movec %d0, %CACR /* Invalidate cache */
461 move.l #0, %d0
462 movec %d0, %ACR0
463 movec %d0, %ACR1
464 movec %d0, %ACR2
465 movec %d0, %ACR3
Alison Wang45370e12012-10-18 19:25:51 +0000[diff] [blame]466#else
Tom Rini65cc0e22022-11-16 13:10:41 -0500[diff] [blame^]467 move.l #(CFG_SYS_INIT_RAM_ADDR + CFG_SYS_INIT_RAM_CTRL), %d0
Alison Wang45370e12012-10-18 19:25:51 +0000[diff] [blame]468 movec %d0, %RAMBAR1
469#endif
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]470
angelo@sysam.it5044c9c2016-04-27 21:50:44 +0200[diff] [blame]471 /* put relocation table address to a5 */
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]472 move.l #__got_start, %a5
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]473
angelo@sysam.it5044c9c2016-04-27 21:50:44 +0200[diff] [blame]474 /* setup stack initially on top of internal static ram */
Tom Rini65cc0e22022-11-16 13:10:41 -0500[diff] [blame^]475 move.l #(CFG_SYS_INIT_RAM_ADDR + CFG_SYS_INIT_RAM_SIZE), %sp
angelo@sysam.it5044c9c2016-04-27 21:50:44 +0200[diff] [blame]476
477 /*
478 * if configured, malloc_f arena will be reserved first,
479 * then (and always) gd struct space will be reserved
480 */
481 move.l %sp, -(%sp)
482 move.l #board_init_f_alloc_reserve, %a1
483 jsr (%a1)
484
485 /* update stack and frame-pointers */
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]486 move.l %d0, %sp
487 move.l %sp, %fp
angelo@sysam.it5044c9c2016-04-27 21:50:44 +0200[diff] [blame]488
489 /* initialize reserved area */
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]490 move.l %d0, -(%sp)
angelo@sysam.it5044c9c2016-04-27 21:50:44 +0200[diff] [blame]491 move.l #board_init_f_init_reserve, %a1
492 jsr (%a1)
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]493
angelo@sysam.it55ac54c2016-04-12 00:30:59 +0200[diff] [blame]494 /* run low-level CPU init code (from flash) */
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]495 move.l #cpu_init_f, %a1
496 jsr (%a1)
497
angelo@sysam.it55ac54c2016-04-12 00:30:59 +0200[diff] [blame]498 /* run low-level board init code (from flash) */
angelo@sysam.it5044c9c2016-04-27 21:50:44 +0200[diff] [blame]499 clr.l %sp@-
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]500 move.l #board_init_f, %a1
501 jsr (%a1)
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]502
503 /* board_init_f() does not return */
504
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]505/******************************************************************************/
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]506
507/*
Simon Glass94133872019-12-28 10:44:45 -0700[diff] [blame]508 * void relocate_code(addr_sp, gd, addr_moni)
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]509 *
510 * This "function" does not return, instead it continues in RAM
511 * after relocating the monitor code.
512 *
513 * r3 = dest
514 * r4 = src
515 * r5 = length in bytes
516 * r6 = cachelinesize
517 */
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]518.globl relocate_code
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]519relocate_code:
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]520 link.w %a6,#0
521 move.l 8(%a6), %sp /* set new stack pointer */
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]522
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]523 move.l 12(%a6), %d0 /* Save copy of Global Data pointer */
524 move.l 16(%a6), %a0 /* Save copy of Destination Address */
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]525
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]526 move.l #CONFIG_SYS_MONITOR_BASE, %a1
527 move.l #__init_end, %a2
528 move.l %a0, %a3
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]529
530 /* copy the code to RAM */
5311:
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]532 move.l (%a1)+, (%a3)+
533 cmp.l %a1,%a2
534 bgt.s 1b
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]535
536/*
537 * We are done. Do not return, instead branch to second part of board
538 * initialization, now running from RAM.
539 */
540 move.l %a0, %a1
Jean-Christophe PLAGNIOL-VILLARD6d0f6bc2008-10-16 15:01:15 +0200[diff] [blame]541 add.l #(in_ram - CONFIG_SYS_MONITOR_BASE), %a1
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]542 jmp (%a1)
543
544in_ram:
545
546clear_bss:
547 /*
548 * Now clear BSS segment
549 */
550 move.l %a0, %a1
Jean-Christophe PLAGNIOL-VILLARD6d0f6bc2008-10-16 15:01:15 +0200[diff] [blame]551 add.l #(_sbss - CONFIG_SYS_MONITOR_BASE),%a1
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]552 move.l %a0, %d1
Jean-Christophe PLAGNIOL-VILLARD6d0f6bc2008-10-16 15:01:15 +0200[diff] [blame]553 add.l #(_ebss - CONFIG_SYS_MONITOR_BASE),%d1
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]5546:
555 clr.l (%a1)+
556 cmp.l %a1,%d1
557 bgt.s 6b
558
559 /*
560 * fix got table in RAM
561 */
562 move.l %a0, %a1
Jean-Christophe PLAGNIOL-VILLARD6d0f6bc2008-10-16 15:01:15 +0200[diff] [blame]563 add.l #(__got_start - CONFIG_SYS_MONITOR_BASE),%a1
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]564 move.l %a1,%a5 /* fix got pointer register a5 */
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]565
566 move.l %a0, %a2
Jean-Christophe PLAGNIOL-VILLARD6d0f6bc2008-10-16 15:01:15 +0200[diff] [blame]567 add.l #(__got_end - CONFIG_SYS_MONITOR_BASE),%a2
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]568
5697:
570 move.l (%a1),%d1
571 sub.l #_start,%d1
572 add.l %a0,%d1
573 move.l %d1,(%a1)+
574 cmp.l %a2, %a1
575 bne 7b
576
577 /* calculate relative jump to board_init_r in ram */
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]578 move.l %a0, %a1
579 add.l #(board_init_r - CONFIG_SYS_MONITOR_BASE), %a1
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]580
581 /* set parameters for board_init_r */
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]582 move.l %a0,-(%sp) /* dest_addr */
583 move.l %d0,-(%sp) /* gd */
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]584 jsr (%a1)
585
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]586/******************************************************************************/
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]587
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]588/* exception code */
589.globl _fault
590_fault:
591 bra _fault
592
593.globl _exc_handler
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]594_exc_handler:
595 SAVE_ALL
596 movel %sp,%sp@-
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]597 bsr exc_handler
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]598 addql #4,%sp
599 RESTORE_ALL
600
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]601.globl _int_handler
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]602_int_handler:
603 SAVE_ALL
604 movel %sp,%sp@-
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]605 bsr int_handler
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]606 addql #4,%sp
607 RESTORE_ALL
608
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]609/******************************************************************************/
TsiChungLiew8ae158c2007-08-16 15:05:11 -0500[diff] [blame]610
Angelo Dureghello5c928d02016-05-22 00:14:29 +0200[diff] [blame]611.align 4