start.S 13.5 KB
Newer Older
wdenk's avatar
wdenk committed
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18 19 20 21 22 23 24
/*
 * Copyright (C) 2003	Josef Baumgartner <josef.baumgartner@telex.de>
 * Based on code from Bernhard Kuhn <bkuhn@metrowerks.com>
 *
 * See file CREDITS for list of people who contributed to this
 * project.
 *
 * This program is free software; you can redistribute it and/or
 * modify it under the terms of the GNU General Public License as
 * published by the Free Software Foundation; either version 2 of
 * the License, or (at your option) any later version.
 *
 * This program is distributed in the hope that it will be useful,
 * but WITHOUT ANY WARRANTY; without even the implied warranty of
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.	 See the
 * GNU General Public License for more details.
 *
 * You should have received a copy of the GNU General Public License
 * along with this program; if not, write to the Free Software
 * Foundation, Inc., 59 Temple Place, Suite 330, Boston,
 * MA 02111-1307 USA
 */

#include <config.h>
25
#include <timestamp.h>
wdenk's avatar
wdenk committed
26 27 28 29 30 31 32 33 34 35 36 37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54 55 56 57 58
#include "version.h"

#ifndef	 CONFIG_IDENT_STRING
#define	 CONFIG_IDENT_STRING ""
#endif


#define _START	_start
#define _FAULT	_fault


#define SAVE_ALL						\
	move.w	#0x2700,%sr;		/* disable intrs */	\
	subl	#60,%sp;		/* space for 15 regs */ \
	moveml	%d0-%d7/%a0-%a6,%sp@;				\

#define RESTORE_ALL						\
	moveml	%sp@,%d0-%d7/%a0-%a6;				\
	addl	#60,%sp;		/* space for 15 regs */ \
	rte

/* If we come from a pre-loader we don't need an initial exception
 * table.
 */
#if !defined(CONFIG_MONITOR_IS_IN_RAM)

.text
/*
 *	Vector table. This is used for initial platform startup.
 *	These vectors are to catch any un-intended traps.
 */
_vectors:

59
.long	0x00000000		/* Flash offset is 0 until we setup CS0 */
60
#if defined(CONFIG_M5282) && (TEXT_BASE == CONFIG_SYS_INT_FLASH_BASE)
61
.long	_start - TEXT_BASE
62
#else
63
.long	_START
64
#endif
65

wdenk's avatar
wdenk committed
66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88 89 90 91 92 93 94 95 96 97 98 99 100 101 102 103 104 105
.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT

.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT

.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT

.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT

#endif

	.text

106

107
#if defined(CONFIG_SYS_INT_FLASH_BASE) && \
108
    (defined(CONFIG_M5282) || defined(CONFIG_M5281))
109
	#if (TEXT_BASE == CONFIG_SYS_INT_FLASH_BASE)
110 111 112 113 114 115 116
		.long	0x55AA55AA,0xAA55AA55 /* CFM Backdoorkey */
		.long	0xFFFFFFFF /* all sectors protected */
		.long	0x00000000 /* supervisor/User restriction */
		.long	0x00000000 /* programm/data space restriction */
		.long	0x00000000 /* Flash security */
	#endif
#endif
wdenk's avatar
wdenk committed
117 118 119 120 121 122
	.globl	_start
_start:
	nop
	nop
	move.w #0x2700,%sr

123
#if defined(CONFIG_M5272) || defined(CONFIG_M5249) || defined(CONFIG_M5253)
124
	move.l	#(CONFIG_SYS_MBAR + 1), %d0		/* set MBAR address + valid flag */
wdenk's avatar
wdenk committed
125 126
	move.c	%d0, %MBAR

stroese's avatar
stroese committed
127
	/*** The 5249 has MBAR2 as well ***/
128 129
#ifdef CONFIG_SYS_MBAR2
	move.l	#(CONFIG_SYS_MBAR2 + 1), %d0	        /* Get MBAR2 address */
stroese's avatar
stroese committed
130 131 132
	movec	%d0, #0xc0e		        /* Set MBAR2 */
#endif

133
	move.l	#(CONFIG_SYS_INIT_RAM_ADDR + 1), %d0
wdenk's avatar
wdenk committed
134
	movec	%d0, %RAMBAR0
135
#endif /* CONFIG_M5272 || CONFIG_M5249 || CONFIG_M5253 */
wdenk's avatar
wdenk committed
136

137
#if defined(CONFIG_M5282) || defined(CONFIG_M5271)
wdenk's avatar
wdenk committed
138
	/* Initialize IPSBAR */
139
	move.l	#(CONFIG_SYS_MBAR + 1), %d0		/* set IPSBAR address + valid flag */
wdenk's avatar
wdenk committed
140 141
	move.l	%d0, 0x40000000

142
	/* Initialize RAMBAR1: locate SRAM and validate it */
143
	move.l	#(CONFIG_SYS_INIT_RAM_ADDR + 0x21), %d0
144 145
	movec	%d0, %RAMBAR1

146
#if defined(CONFIG_M5282)
147
#if (TEXT_BASE == CONFIG_SYS_INT_FLASH_BASE)
148 149
	/* Setup code in SRAM to initialize FLASHBAR, if start from internal Flash */

150 151 152
	move.l #(_flashbar_setup-CONFIG_SYS_INT_FLASH_BASE), %a0
	move.l #(_flashbar_setup_end-CONFIG_SYS_INT_FLASH_BASE), %a1
	move.l #(CONFIG_SYS_INIT_RAM_ADDR), %a2
153 154 155 156
_copy_flash:
	move.l (%a0)+, (%a2)+
	cmp.l %a0, %a1
	bgt.s _copy_flash
157
	jmp CONFIG_SYS_INIT_RAM_ADDR
158 159

_flashbar_setup:
wdenk's avatar
wdenk committed
160
	/* Initialize FLASHBAR: locate internal Flash and validate it */
161
	move.l	#(CONFIG_SYS_INT_FLASH_BASE + CONFIG_SYS_INT_FLASH_ENABLE), %d0
162
	movec	%d0, %FLASHBAR
163 164 165 166 167 168
	jmp _after_flashbar_copy.L	/* Force jump to absolute address */
_flashbar_setup_end:
	nop
_after_flashbar_copy:
#else
	/* Setup code to initialize FLASHBAR, if start from external Memory */
169
	move.l	#(CONFIG_SYS_INT_FLASH_BASE + CONFIG_SYS_INT_FLASH_ENABLE), %d0
170
	movec	%d0, %FLASHBAR
171
#endif /* (TEXT_BASE == CONFIG_SYS_INT_FLASH_BASE) */
wdenk's avatar
wdenk committed
172

Wolfgang Denk's avatar
Wolfgang Denk committed
173
#endif
174 175 176 177 178
#endif
	/* if we come from a pre-loader we have no exception table and
	 * therefore no VBR to set
	 */
#if !defined(CONFIG_MONITOR_IS_IN_RAM)
179 180
#if defined(CONFIG_M5282) && (TEXT_BASE == CONFIG_SYS_INT_FLASH_BASE)
	move.l	#CONFIG_SYS_INT_FLASH_BASE, %d0
181
#else
182
	move.l	#CONFIG_SYS_FLASH_BASE, %d0
183
#endif
184
	movec	%d0, %VBR
185 186
#endif

187 188
#ifdef CONFIG_M5275
	/* Initialize IPSBAR */
189
	move.l	#(CONFIG_SYS_MBAR + 1), %d0		/* set IPSBAR address + valid flag */
190 191 192 193
	move.l	%d0, 0x40000000
/*	movec	%d0, %MBAR */

	/* Initialize RAMBAR: locate SRAM and validate it */
194
	move.l	#(CONFIG_SYS_INIT_RAM_ADDR + 0x21), %d0
195 196 197
	movec	%d0, %RAMBAR1
#endif

198
#if 0
wdenk's avatar
wdenk committed
199 200 201 202 203 204
	/* invalidate and disable cache */
	move.l	#0x01000000, %d0		/* Invalidate cache cmd */
	movec	%d0, %CACR			/* Invalidate cache */
	move.l	#0, %d0
	movec	%d0, %ACR0
	movec	%d0, %ACR1
205
#endif
wdenk's avatar
wdenk committed
206 207

	/* set stackpointer to end of internal ram to get some stackspace for the first c-code */
208
	move.l	#(CONFIG_SYS_INIT_RAM_ADDR + CONFIG_SYS_INIT_SP_OFFSET), %sp
wdenk's avatar
wdenk committed
209 210 211 212 213 214 215
	clr.l %sp@-

	move.l #__got_start, %a5		/* put relocation table address to a5 */

	bsr cpu_init_f				/* run low-level CPU init code (from flash) */
	bsr board_init_f			/* run low-level board init code (from flash) */

216
	/* board_init_f() does not return */
wdenk's avatar
wdenk committed
217 218 219 220 221 222 223 224 225 226 227 228 229 230 231 232 233 234 235 236 237 238

/*------------------------------------------------------------------------------*/

/*
 * void relocate_code (addr_sp, gd, addr_moni)
 *
 * This "function" does not return, instead it continues in RAM
 * after relocating the monitor code.
 *
 * r3 = dest
 * r4 = src
 * r5 = length in bytes
 * r6 = cachelinesize
 */
	.globl	relocate_code
relocate_code:
	link.w %a6,#0
	move.l 8(%a6), %sp		/* set new stack pointer */

	move.l 12(%a6), %d0		/* Save copy of Global Data pointer */
	move.l 16(%a6), %a0		/* Save copy of Destination Address */

239
	move.l #CONFIG_SYS_MONITOR_BASE, %a1
wdenk's avatar
wdenk committed
240 241 242 243 244 245 246 247 248 249 250 251
	move.l #__init_end, %a2
	move.l %a0, %a3
	/* copy the code to RAM */
1:
	move.l (%a1)+, (%a3)+
	cmp.l  %a1,%a2
	bgt.s	 1b

/*
 * We are done. Do not return, instead branch to second part of board
 * initialization, now running from RAM.
 */
Wolfgang Denk's avatar
Wolfgang Denk committed
252
	move.l	%a0, %a1
253
	add.l	#(in_ram - CONFIG_SYS_MONITOR_BASE), %a1
wdenk's avatar
wdenk committed
254 255 256 257 258
	jmp	(%a1)

in_ram:

clear_bss:
Wolfgang Denk's avatar
Wolfgang Denk committed
259
	/*
wdenk's avatar
wdenk committed
260 261 262
	 * Now clear BSS segment
	 */
	move.l	%a0, %a1
263
	add.l	#(_sbss - CONFIG_SYS_MONITOR_BASE),%a1
wdenk's avatar
wdenk committed
264
	move.l	%a0, %d1
265
	add.l	#(_ebss - CONFIG_SYS_MONITOR_BASE),%d1
wdenk's avatar
wdenk committed
266 267 268 269 270 271 272 273 274
6:
	clr.l	(%a1)+
	cmp.l	%a1,%d1
	bgt.s	6b

	/*
	 * fix got table in RAM
	 */
	move.l	%a0, %a1
275
	add.l	#(__got_start - CONFIG_SYS_MONITOR_BASE),%a1
wdenk's avatar
wdenk committed
276 277 278
	move.l	%a1,%a5		/* * fix got pointer register a5 */

	move.l	%a0, %a2
279
	add.l	#(__got_end - CONFIG_SYS_MONITOR_BASE),%a2
wdenk's avatar
wdenk committed
280 281 282 283 284 285 286 287 288

7:
	move.l	(%a1),%d1
	sub.l	#_start,%d1
	add.l	%a0,%d1
	move.l	%d1,(%a1)+
	cmp.l	%a2, %a1
	bne	7b

289 290 291 292 293
#if defined(CONFIG_M5281) || defined(CONFIG_M5282)
	/* patch the 3 accesspoints to 3 ichache_state */
	/* quick and dirty */

	move.l	%a0,%d1
294
	add.l	#(icache_state - CONFIG_SYS_MONITOR_BASE),%d1
295
	move.l	%a0,%a1
296
	add.l	#(icache_state_access_1+2 - CONFIG_SYS_MONITOR_BASE),%a1
297 298
	move.l  %d1,(%a1)
	move.l	%a0,%a1
299
	add.l	#(icache_state_access_2+2 - CONFIG_SYS_MONITOR_BASE),%a1
300 301
	move.l  %d1,(%a1)
	move.l	%a0,%a1
302
	add.l	#(icache_state_access_3+2 - CONFIG_SYS_MONITOR_BASE),%a1
303 304 305
	move.l  %d1,(%a1)
#endif

wdenk's avatar
wdenk committed
306 307
	/* calculate relative jump to board_init_r in ram */
	move.l %a0, %a1
308
	add.l #(board_init_r - CONFIG_SYS_MONITOR_BASE), %a1
wdenk's avatar
wdenk committed
309 310 311 312

	/* set parameters for board_init_r */
	move.l %a0,-(%sp)		/* dest_addr */
	move.l %d0,-(%sp)		/* gd */
313 314
#if defined(DEBUG) && (TEXT_BASE != CONFIG_SYS_INT_FLASH_BASE) && \
    defined(CONFIG_SYS_HALT_BEFOR_RAM_JUMP)
TsiChungLiew's avatar
TsiChungLiew committed
315 316
	halt
#endif
wdenk's avatar
wdenk committed
317 318 319 320 321 322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342
	jsr	(%a1)

/*------------------------------------------------------------------------------*/
/* exception code */
	.globl _fault
_fault:
	jmp _fault

	.globl	_exc_handler
_exc_handler:
	SAVE_ALL
	movel	%sp,%sp@-
	bsr exc_handler
	addql	#4,%sp
	RESTORE_ALL

	.globl	_int_handler
_int_handler:
	SAVE_ALL
	movel	%sp,%sp@-
	bsr int_handler
	addql	#4,%sp
	RESTORE_ALL

/*------------------------------------------------------------------------------*/
/* cache functions */
TsiChungLiew's avatar
TsiChungLiew committed
343 344 345 346 347
#ifdef	CONFIG_M5271
	.globl	icache_enable
icache_enable:
	move.l	#0x01000000, %d0		/* Invalidate cache cmd */
	movec	%d0, %CACR			/* Invalidate cache */
348
	move.l	#(CONFIG_SYS_SDRAM_BASE + 0xc000), %d0	/* Setup cache mask */
TsiChungLiew's avatar
TsiChungLiew committed
349 350 351 352 353 354
	movec	%d0, %ACR0			/* Enable cache */

	move.l	#0x80000200, %d0		/* Setup cache mask */
	movec	%d0, %CACR			/* Enable cache */
	nop

355
	move.l #(CONFIG_SYS_INIT_RAM_ADDR+CONFIG_SYS_INIT_RAM_END-8), %a1
TsiChungLiew's avatar
TsiChungLiew committed
356 357 358 359 360
	moveq	#1, %d0
	move.l	%d0, (%a1)
	rts
#endif

wdenk's avatar
wdenk committed
361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376
#ifdef	CONFIG_M5272
	.globl	icache_enable
icache_enable:
	move.l	#0x01000000, %d0		/* Invalidate cache cmd */
	movec	%d0, %CACR			/* Invalidate cache */
	move.l	#0x0000c000, %d0		/* Setup cache mask */
	movec	%d0, %ACR0			/* Enable cache */
	move.l	#0xff00c000, %d0		/* Setup cache mask */
	movec	%d0, %ACR1			/* Enable cache */
	move.l	#0x80000100, %d0		/* Setup cache mask */
	movec	%d0, %CACR			/* Enable cache */
	moveq	#1, %d0
	move.l	%d0, icache_state
	rts
#endif

377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394 395
#if  defined(CONFIG_M5275)
/*
 * Instruction cache only
 */
	.globl	icache_enable
icache_enable:
	move.l	#0x01400000, %d0		/* Invalidate cache cmd */
	movec	%d0, %CACR			/* Invalidate cache */
	move.l	#0x0000c000, %d0		/* Setup SDRAM caching */
	movec	%d0, %ACR0			/* Enable cache */
	move.l	#0x00000000, %d0		/* No other caching */
	movec	%d0, %ACR1			/* Enable cache */
	move.l	#0x80400100, %d0		/* Setup cache mask */
	movec	%d0, %CACR			/* Enable cache */
	moveq	#1, %d0
	move.l	%d0, icache_state
	rts
#endif

wdenk's avatar
wdenk committed
396 397 398 399 400 401 402 403 404 405 406 407
#ifdef CONFIG_M5282
	.globl	icache_enable
icache_enable:
	move.l	#0x01000000, %d0		/* Invalidate cache cmd */
	movec	%d0, %CACR			/* Invalidate cache */
	move.l	#0x0000c000, %d0		/* Setup cache mask */
	movec	%d0, %ACR0			/* Enable cache */
	move.l	#0xff00c000, %d0		/* Setup cache mask */
	movec	%d0, %ACR1			/* Enable cache */
	move.l	#0x80400100, %d0		/* Setup cache mask, data cache disabel*/
	movec	%d0, %CACR			/* Enable cache */
	moveq	#1, %d0
408
icache_state_access_1:
wdenk's avatar
wdenk committed
409 410 411 412
	move.l	%d0, icache_state
	rts
#endif

413
#if defined(CONFIG_M5249) || defined(CONFIG_M5253)
stroese's avatar
stroese committed
414 415 416 417 418 419
	.globl	icache_enable
icache_enable:
	/*
	 *  Note: The 5249 Documentation doesn't give a bit position for CINV!
	 *  From the 5272 and the 5307 documentation, I have deduced that it is
	 *  probably CACR[24]. Should someone say something to Motorola?
Wolfgang Denk's avatar
Wolfgang Denk committed
420
	 *	~Jeremy
stroese's avatar
stroese committed
421 422 423 424 425 426 427 428 429 430 431 432 433 434
	 */
	move.l	#0x01000000, %d0		/* Invalidate whole cache */
	move.c	%d0,%CACR
	move.l	#0xff00c000, %d0		/* Set FLASH cachable: always match (SM=0b10) */
	move.c	%d0, %ACR0
	move.l	#0x0000c000, %d0		/* Set SDRAM cachable: always match (SM=0b10) */
	move.c	%d0, %ACR1
	move.l	#0x90000200, %d0		/* Set cache enable cmd */
	move.c	%d0,%CACR
	moveq	#1, %d0
	move.l	%d0, icache_state
	rts
#endif

wdenk's avatar
wdenk committed
435 436 437 438 439 440 441 442
	.globl	icache_disable
icache_disable:
	move.l	#0x00000100, %d0		/* Setup cache mask */
	movec	%d0, %CACR			/* Enable cache */
	clr.l	%d0				/* Setup cache mask */
	movec	%d0, %ACR0			/* Enable cache */
	movec	%d0, %ACR1			/* Enable cache */
	moveq	#0, %d0
443
icache_state_access_2:
wdenk's avatar
wdenk committed
444 445 446 447 448
	move.l	%d0, icache_state
	rts

	.globl	icache_status
icache_status:
449
icache_state_access_3:
TsiChungLiew's avatar
TsiChungLiew committed
450 451
	move.l	#(icache_state), %a0
	move.l	(%a0), %d0
wdenk's avatar
wdenk committed
452 453 454 455
	rts

	.data
icache_state:
456
	.long	0	/* cache is diabled on inirialization */
stroese's avatar
stroese committed
457

TsiChungLiew's avatar
TsiChungLiew committed
458 459 460 461 462 463 464 465 466 467 468 469 470 471 472
	.globl	dcache_enable
dcache_enable:
	/* dummy function */
	rts

	.globl	dcache_disable
dcache_disable:
	/* dummy function */
	rts

	.globl	dcache_status
dcache_status:
	/* dummy function */
	rts

wdenk's avatar
wdenk committed
473 474 475 476 477
/*------------------------------------------------------------------------------*/

	.globl	version_string
version_string:
	.ascii U_BOOT_VERSION
478
	.ascii " (", U_BOOT_DATE, " - ", U_BOOT_TIME, ")"
wdenk's avatar
wdenk committed
479
	.ascii CONFIG_IDENT_STRING, "\0"
480
	.align 4