1/* SPDX-License-Identifier: GPL-2.0+ */
2/*
3 * Copyright (C) 2003	Josef Baumgartner <josef.baumgartner@telex.de>
4 * Based on code from Bernhard Kuhn <bkuhn@metrowerks.com>
5 *
6 * (C) Copyright 2004-2008 Freescale Semiconductor, Inc.
7 * TsiChung Liew (Tsi-Chung.Liew@freescale.com)
8 */
9
10#include <asm-offsets.h>
11#include <config.h>
12#include <asm/cache.h>
13
14#define _START	_start
15#define _FAULT	_fault
16
17#define SAVE_ALL						\
18	move.w	#0x2700,%sr;		/* disable intrs */	\
19	subl	#60,%sp;		/* space for 15 regs */ \
20	moveml	%d0-%d7/%a0-%a6,%sp@;
21
22#define RESTORE_ALL						\
23	moveml	%sp@,%d0-%d7/%a0-%a6;				\
24	addl	#60,%sp;		/* space for 15 regs */ \
25	rte;
26
27#if !defined(CONFIG_MONITOR_IS_IN_RAM)
28
29.text
30
31/*
32 * Vector table. This is used for initial platform startup.
33 * These vectors are to catch any un-intended traps.
34 */
35_vectors:
36INITSP:	.long	0x00000000		/* Initial SP	*/
37INITPC:	.long	_START			/* Initial PC		*/
38
39vector02_0F:
40.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
41.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
42
43/* Reserved */
44vector10_17:
45.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
46
47vector18_1F:
48.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
49
50/* TRAP #0 - #15 */
51vector20_2F:
52.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
53.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
54
55/* Reserved	*/
56vector30_3F:
57.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
58.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
59
60vector64_127:
61.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
62.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
63.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
64.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
65.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
66.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
67.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
68.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
69
70vector128_191:
71.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
72.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
73.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
74.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
75.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
76.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
77.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
78.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
79
80vector192_255:
81.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
82.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
83.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
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#endif /* !defined(CONFIG_MONITOR_IS_IN_RAM) */
90
91.text
92
93.globl _start
94_start:
95	nop
96	nop
97	move.w	#0x2700,%sr	/* Mask off Interrupt */
98
99#if !defined(CONFIG_MONITOR_IS_IN_RAM)
100	/* Set vector base register at the beginning of the Flash */
101	move.l	#CONFIG_SYS_FLASH_BASE, %d0
102	movec	%d0, %VBR
103#endif
104
105	move.l	#(CONFIG_SYS_INIT_RAM_ADDR + CONFIG_SYS_INIT_RAM_CTRL), %d0
106	movec	%d0, %RAMBAR1
107
108	/* invalidate and disable cache */
109	move.l	#CF_CACR_CINVA, %d0		/* Invalidate cache cmd */
110	movec	%d0, %CACR			/* Invalidate cache */
111	move.l	#0, %d0
112	movec	%d0, %ACR0
113	movec	%d0, %ACR1
114
115#ifdef CONFIG_MCF5301x
116	move.l	#(0xFC0a0010), %a0
117	move.w	(%a0), %d0
118	and.l	%d0, 0xEFFF
119
120	move.w	%d0, (%a0)
121#endif
122
123	/* initialize general use internal ram */
124	move.l	#0, %d0
125	move.l	#(ICACHE_STATUS), %a1	/* icache */
126	move.l	#(DCACHE_STATUS), %a2	/* icache */
127	move.l	%d0, (%a1)
128	move.l	%d0, (%a2)
129
130	/* put relocation table address to a5 */
131	move.l	#__got_start, %a5
132
133	/* setup stack initially on top of internal static ram  */
134	move.l  #(CONFIG_SYS_INIT_RAM_ADDR + CONFIG_SYS_INIT_RAM_SIZE), %sp
135
136	/*
137	 * if configured, malloc_f arena will be reserved first,
138	 * then (and always) gd struct space will be reserved
139	 */
140	move.l	%sp, -(%sp)
141	move.l	#board_init_f_alloc_reserve, %a1
142	jsr	(%a1)
143
144	/* update stack and frame-pointers */
145	move.l  %d0, %sp
146	move.l  %sp, %fp
147
148	/* initialize reserved area */
149	move.l	%d0, -(%sp)
150	move.l	#board_init_f_init_reserve, %a1
151	jsr	(%a1)
152
153	/* run low-level CPU init code (from flash) */
154	move.l	#cpu_init_f, %a1
155	jsr	(%a1)
156
157	/* run low-level board init code (from flash) */
158	clr.l   %sp@-
159	move.l #board_init_f, %a1
160	jsr (%a1)
161
162	/* board_init_f() does not return */
163
164/******************************************************************************/
165
166/*
167 * void relocate_code(addr_sp, gd, addr_moni)
168 *
169 * This "function" does not return, instead it continues in RAM
170 * after relocating the monitor code.
171 *
172 * r3 = dest
173 * r4 = src
174 * r5 = length in bytes
175 * r6 = cachelinesize
176 */
177.globl relocate_code
178relocate_code:
179	link.w	%a6,#0
180	move.l	8(%a6), %sp		/* set new stack pointer */
181
182	move.l	12(%a6), %d0		/* Save copy of Global Data pointer */
183	move.l	16(%a6), %a0		/* Save copy of Destination Address */
184
185	move.l	#CONFIG_SYS_MONITOR_BASE, %a1
186	move.l	#__init_end, %a2
187	move.l	%a0, %a3
188
189	/* copy the code to RAM */
1901:
191	move.l	(%a1)+, (%a3)+
192	cmp.l	%a1,%a2
193	bgt.s	1b
194
195/*
196 * We are done. Do not return, instead branch to second part of board
197 * initialization, now running from RAM.
198 */
199	move.l	%a0, %a1
200	add.l	#(in_ram - CONFIG_SYS_MONITOR_BASE), %a1
201	jmp	(%a1)
202
203in_ram:
204
205clear_bss:
206	/*
207	 * Now clear BSS segment
208	 */
209	move.l	%a0, %a1
210	add.l	#(_sbss - CONFIG_SYS_MONITOR_BASE),%a1
211	move.l	%a0, %d1
212	add.l	#(_ebss - CONFIG_SYS_MONITOR_BASE),%d1
2136:
214	clr.l	(%a1)+
215	cmp.l	%a1,%d1
216	bgt.s	6b
217
218	/*
219	 * fix got table in RAM
220	 */
221	move.l	%a0, %a1
222	add.l	#(__got_start - CONFIG_SYS_MONITOR_BASE),%a1
223	move.l	%a1,%a5			/* fix got pointer register a5 */
224
225	move.l	%a0, %a2
226	add.l	#(__got_end - CONFIG_SYS_MONITOR_BASE),%a2
227
2287:
229	move.l	(%a1),%d1
230	sub.l	#_start,%d1
231	add.l	%a0,%d1
232	move.l	%d1,(%a1)+
233	cmp.l	%a2, %a1
234	bne	7b
235
236	/* calculate relative jump to board_init_r in ram */
237	move.l	%a0, %a1
238	add.l	#(board_init_r - CONFIG_SYS_MONITOR_BASE), %a1
239
240	/* set parameters for board_init_r */
241	move.l	%a0,-(%sp)		/* dest_addr */
242	move.l	%d0,-(%sp)		/* gd */
243	jsr	(%a1)
244
245/******************************************************************************/
246
247/* exception code */
248.globl _fault
249_fault:
250	bra _fault
251
252.globl _exc_handler
253_exc_handler:
254	SAVE_ALL
255	movel	%sp,%sp@-
256	bsr	exc_handler
257	addql	#4,%sp
258	RESTORE_ALL
259
260.globl _int_handler
261_int_handler:
262	SAVE_ALL
263	movel	%sp,%sp@-
264	bsr	int_handler
265	addql	#4,%sp
266	RESTORE_ALL
267
268/******************************************************************************/
269
270.align 4
271