[people/ms/u-boot.git] / cpu / mcf532x / start.S

/*
 * Copyright (C) 2003	Josef Baumgartner <josef.baumgartner@telex.de>
 * Based on code from Bernhard Kuhn <bkuhn@metrowerks.com>
 *
 * (C) Copyright 2004-2008 Freescale Semiconductor, Inc.
 * TsiChung Liew (Tsi-Chung.Liew@freescale.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>
#include <timestamp.h>
#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;

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

INITSP:		.long	0x00000000	/* Initial SP	*/
INITPC:		.long	_START	/* Initial PC		*/
vector02:	.long	_FAULT	/* Access Error		*/
vector03:	.long	_FAULT	/* Address Error	*/
vector04:	.long	_FAULT	/* Illegal Instruction	*/
vector05:	.long	_FAULT	/* Reserved		*/
vector06:	.long	_FAULT	/* Reserved		*/
vector07:	.long	_FAULT	/* Reserved		*/
vector08:	.long	_FAULT	/* Privilege Violation	*/
vector09:	.long	_FAULT	/* Trace		*/
vector0A:	.long	_FAULT	/* Unimplemented A-Line	*/
vector0B:	.long	_FAULT	/* Unimplemented F-Line	*/
vector0C:	.long	_FAULT	/* Debug Interrupt	*/
vector0D:	.long	_FAULT	/* Reserved		*/
vector0E:	.long	_FAULT	/* Format Error		*/
vector0F:	.long	_FAULT	/* Unitialized Int.	*/

/* Reserved */
vector10_17:
.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT

vector18:	.long	_FAULT	/* Spurious Interrupt	*/
vector19:	.long	_FAULT	/* Autovector Level 1	*/
vector1A:	.long	_FAULT	/* Autovector Level 2	*/
vector1B:	.long	_FAULT	/* Autovector Level 3	*/
vector1C:	.long	_FAULT	/* Autovector Level 4	*/
vector1D:	.long	_FAULT	/* Autovector Level 5	*/
vector1E:	.long	_FAULT	/* Autovector Level 6	*/
vector1F:	.long	_FAULT	/* Autovector Level 7	*/

/* TRAP #0 - #15 */
vector20_2F:
.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT

/* Reserved	*/
vector30_3F:
.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
.long	_FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT

vector64_127:
.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

vector128_191:
.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

vector192_255:
.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

	.text

	.globl	_start
_start:
	nop
	nop
	move.w #0x2700,%sr	/* Mask off Interrupt */

	/* Set vector base register at the beginning of the Flash */
	move.l	#CONFIG_SYS_FLASH_BASE, %d0
	movec	%d0, %VBR

	move.l	#(CONFIG_SYS_INIT_RAM_ADDR + CONFIG_SYS_INIT_RAM_CTRL), %d0
	movec	%d0, %RAMBAR1

	/* 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

#ifdef CONFIG_MCF5301x
	move.l	#(0xFC0a0010), %a0
	move.w	(%a0), %d0
	and.l	%d0, 0xEFFF

	move.w	%d0, (%a0)
#endif

	/* initialize general use internal ram */
	move.l #0, %d0
	move.l #(CONFIG_SYS_INIT_RAM_ADDR+CONFIG_SYS_INIT_RAM_END-8), %a1
	move.l #(CONFIG_SYS_INIT_RAM_ADDR+CONFIG_SYS_INIT_RAM_END-4), %a2
	move.l %d0, (%a1)
	move.l %d0, (%a2)

	/* set stackpointer to end of internal ram to get some stackspace for the
	   first c-code */
	move.l	#(CONFIG_SYS_INIT_RAM_ADDR + CONFIG_SYS_INIT_SP_OFFSET), %sp
	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) */

	/* board_init_f() does not return */

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

/*
 * 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 */

	move.l #CONFIG_SYS_MONITOR_BASE, %a1
	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.
 */
	move.l	%a0, %a1
	add.l	#(in_ram - CONFIG_SYS_MONITOR_BASE), %a1
	jmp	(%a1)

in_ram:

clear_bss:
	/*
	 * Now clear BSS segment
	 */
	move.l	%a0, %a1
	add.l	#(_sbss - CONFIG_SYS_MONITOR_BASE),%a1
	move.l	%a0, %d1
	add.l	#(_ebss - CONFIG_SYS_MONITOR_BASE),%d1
6:
	clr.l	(%a1)+
	cmp.l	%a1,%d1
	bgt.s	6b

	/*
	 * fix got table in RAM
	 */
	move.l	%a0, %a1
	add.l	#(__got_start - CONFIG_SYS_MONITOR_BASE),%a1
	move.l	%a1,%a5		/* * fix got pointer register a5 */

	move.l	%a0, %a2
	add.l	#(__got_end - CONFIG_SYS_MONITOR_BASE),%a2

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

	/* calculate relative jump to board_init_r in ram */
	move.l %a0, %a1
	add.l #(board_init_r - CONFIG_SYS_MONITOR_BASE), %a1

	/* set parameters for board_init_r */
	move.l %a0,-(%sp)		/* dest_addr */
	move.l %d0,-(%sp)		/* gd */
	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 */
	.globl	icache_enable
icache_enable:
	move.l	#0x01000000, %d0		/* Invalidate cache cmd */
	movec	%d0, %CACR			/* Invalidate cache */
	move.l  #(CONFIG_SYS_SDRAM_BASE + 0xc000 + ((CONFIG_SYS_SDRAM_SIZE & 0x1fe0) << 11)), %d0
	movec	%d0, %ACR0			/* Enable cache */

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

	move.l #(CONFIG_SYS_INIT_RAM_ADDR+CONFIG_SYS_INIT_RAM_END-8), %a1
	moveq	#1, %d0
	move.l	%d0, (%a1)
	rts

	.globl	icache_disable
icache_disable:
	move.l	#0x01000000, %d0		/* Setup cache mask */
	movec	%d0, %CACR			/* Disable cache */
	clr.l	%d0				/* Setup cache mask */
	movec	%d0, %ACR0
	movec	%d0, %ACR1

	move.l #(CONFIG_SYS_INIT_RAM_ADDR+CONFIG_SYS_INIT_RAM_END-8), %a1
	moveq	#0, %d0
	move.l	%d0, (%a1)
	rts

	.globl	icache_status
icache_status:
	move.l #(CONFIG_SYS_INIT_RAM_ADDR+CONFIG_SYS_INIT_RAM_END-8), %a1
	move.l	(%a1), %d0
	rts

	.globl	icache_invalid
icache_invalid:
	move.l	#0x81000200, %d0		/* Setup cache mask */
	movec	%d0, %CACR			/* Enable cache */
	rts

	.globl	dcache_enable
dcache_enable:
	move.l #(CONFIG_SYS_INIT_RAM_ADDR+CONFIG_SYS_INIT_RAM_END-4), %a1
	moveq	#1, %d0
	move.l	%d0, (%a1)
	rts

    /* No dcache, just a dummy function */
	.globl	dcache_disable
dcache_disable:
	move.l #(CONFIG_SYS_INIT_RAM_ADDR+CONFIG_SYS_INIT_RAM_END-4), %a1
	moveq	#0, %d0
	move.l	%d0, (%a1)
	rts

	.globl	dcache_status
dcache_status:
	move.l #(CONFIG_SYS_INIT_RAM_ADDR+CONFIG_SYS_INIT_RAM_END-4), %a1
	move.l	(%a1), %d0
	rts

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

	.globl	version_string
version_string:
	.ascii U_BOOT_VERSION
	.ascii " (", U_BOOT_DATE, " - ", U_BOOT_TIME, ")"
	.ascii CONFIG_IDENT_STRING, "\0"
	.align 4
Commit	Line	Data
8e585f02 TL	1	/*
	2	* Copyright (C) 2003 Josef Baumgartner <josef.baumgartner@telex.de>
	3	* Based on code from Bernhard Kuhn <bkuhn@metrowerks.com>
	4	*
536e7dac TL	5	* (C) Copyright 2004-2008 Freescale Semiconductor, Inc.
	6	* TsiChung Liew (Tsi-Chung.Liew@freescale.com)
	7	*
8e585f02 TL	8	* See file CREDITS for list of people who contributed to this
	9	* project.
	10	*
	11	* This program is free software; you can redistribute it and/or
	12	* modify it under the terms of the GNU General Public License as
	13	* published by the Free Software Foundation; either version 2 of
	14	* the License, or (at your option) any later version.
	15	*
	16	* This program is distributed in the hope that it will be useful,
	17	* but WITHOUT ANY WARRANTY; without even the implied warranty of
	18	* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
	19	* GNU General Public License for more details.
	20	*
	21	* You should have received a copy of the GNU General Public License
	22	* along with this program; if not, write to the Free Software
	23	* Foundation, Inc., 59 Temple Place, Suite 330, Boston,
	24	* MA 02111-1307 USA
	25	*/
	26
	27	#include <config.h>
561858ee	28	#include <timestamp.h>
8e585f02 TL	29	#include "version.h"
	30
	31	#ifndef CONFIG_IDENT_STRING
	32	#define CONFIG_IDENT_STRING ""
	33	#endif
	34
	35	#define _START _start
	36	#define _FAULT _fault
	37
8e585f02 TL	38	#define SAVE_ALL \
	39	move.w #0x2700,%sr; /* disable intrs */ \
	40	subl #60,%sp; /* space for 15 regs */ \
	41	moveml %d0-%d7/%a0-%a6,%sp@;
	42
	43	#define RESTORE_ALL \
	44	moveml %sp@,%d0-%d7/%a0-%a6; \
	45	addl #60,%sp; /* space for 15 regs */ \
	46	rte;
	47
8e585f02 TL	48	.text
	49	/*
	50	* Vector table. This is used for initial platform startup.
	51	* These vectors are to catch any un-intended traps.
	52	*/
	53	_vectors:
	54
ddd104f1	55	INITSP: .long 0x00000000 /* Initial SP */
53677ef1	56	INITPC: .long _START /* Initial PC */
ddd104f1 TL	57	vector02: .long _FAULT /* Access Error */
	58	vector03: .long _FAULT /* Address Error */
	59	vector04: .long _FAULT /* Illegal Instruction */
	60	vector05: .long _FAULT /* Reserved */
	61	vector06: .long _FAULT /* Reserved */
	62	vector07: .long _FAULT /* Reserved */
	63	vector08: .long _FAULT /* Privilege Violation */
	64	vector09: .long _FAULT /* Trace */
	65	vector0A: .long _FAULT /* Unimplemented A-Line */
	66	vector0B: .long _FAULT /* Unimplemented F-Line */
	67	vector0C: .long _FAULT /* Debug Interrupt */
	68	vector0D: .long _FAULT /* Reserved */
	69	vector0E: .long _FAULT /* Format Error */
	70	vector0F: .long _FAULT /* Unitialized Int. */
	71
	72	/* Reserved */
8e585f02 TL	73	vector10_17:
	74	.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
	75
ddd104f1 TL	76	vector18: .long _FAULT /* Spurious Interrupt */
	77	vector19: .long _FAULT /* Autovector Level 1 */
	78	vector1A: .long _FAULT /* Autovector Level 2 */
	79	vector1B: .long _FAULT /* Autovector Level 3 */
	80	vector1C: .long _FAULT /* Autovector Level 4 */
	81	vector1D: .long _FAULT /* Autovector Level 5 */
	82	vector1E: .long _FAULT /* Autovector Level 6 */
	83	vector1F: .long _FAULT /* Autovector Level 7 */
8e585f02 TL	84
	85	/* TRAP #0 - #15 */
	86	vector20_2F:
	87	.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
	88	.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
	89
	90	/* Reserved */
	91	vector30_3F:
	92	.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
	93	.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
	94
	95	vector64_127:
	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	.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
	103	.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
	104
	105	vector128_191:
	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
	112	.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
	113	.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
	114
	115	vector192_255:
	116	.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
	117	.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
	118	.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
	119	.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
	120	.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
	121	.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
	122	.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
	123	.long _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT, _FAULT
	124
	125	.text
	126
	127	.globl _start
	128	_start:
	129	nop
	130	nop
ddd104f1	131	move.w #0x2700,%sr /* Mask off Interrupt */
8e585f02	132
ddd104f1	133	/* Set vector base register at the beginning of the Flash */
6d0f6bcf	134	move.l #CONFIG_SYS_FLASH_BASE, %d0
8e585f02 TL	135	movec %d0, %VBR
8e585f02 TL	136
6d0f6bcf	137	move.l #(CONFIG_SYS_INIT_RAM_ADDR + CONFIG_SYS_INIT_RAM_CTRL), %d0
c67e12e7	138	movec %d0, %RAMBAR1
8e585f02 TL	139
	140	/* invalidate and disable cache */
	141	move.l #0x01000000, %d0 /* Invalidate cache cmd */
	142	movec %d0, %CACR /* Invalidate cache */
	143	move.l #0, %d0
	144	movec %d0, %ACR0
	145	movec %d0, %ACR1
	146
536e7dac TL	147	#ifdef CONFIG_MCF5301x
	148	move.l #(0xFC0a0010), %a0
	149	move.w (%a0), %d0
	150	and.l %d0, 0xEFFF
	151
	152	move.w %d0, (%a0)
	153	#endif
	154
8e585f02 TL	155	/* initialize general use internal ram */
8e585f02 TL	156	move.l #0, %d0
6d0f6bcf JCPV	157	move.l #(CONFIG_SYS_INIT_RAM_ADDR+CONFIG_SYS_INIT_RAM_END-8), %a1
6d0f6bcf JCPV	158	move.l #(CONFIG_SYS_INIT_RAM_ADDR+CONFIG_SYS_INIT_RAM_END-4), %a2
8e585f02 TL	159	move.l %d0, (%a1)
	160	move.l %d0, (%a2)
	161
ddd104f1 TL	162	/* set stackpointer to end of internal ram to get some stackspace for the
ddd104f1 TL	163	first c-code */
6d0f6bcf	164	move.l #(CONFIG_SYS_INIT_RAM_ADDR + CONFIG_SYS_INIT_SP_OFFSET), %sp
8e585f02 TL	165	clr.l %sp@-
8e585f02 TL	166
ddd104f1	167	move.l #__got_start, %a5 /* put relocation table address to a5 */
8e585f02	168
ddd104f1 TL	169	bsr cpu_init_f /* run low-level CPU init code (from flash) */
ddd104f1 TL	170	bsr board_init_f /* run low-level board init code (from flash) */
8e585f02 TL	171
	172	/* board_init_f() does not return */
	173
	174	/------------------------------------------------------------------------------/
	175
	176	/*
	177	* void relocate_code (addr_sp, gd, addr_moni)
	178	*
	179	* This "function" does not return, instead it continues in RAM
	180	* after relocating the monitor code.
	181	*
	182	* r3 = dest
	183	* r4 = src
	184	* r5 = length in bytes
	185	* r6 = cachelinesize
	186	*/
	187	.globl relocate_code
	188	relocate_code:
	189	link.w %a6,#0
	190	move.l 8(%a6), %sp /* set new stack pointer */
	191
	192	move.l 12(%a6), %d0 /* Save copy of Global Data pointer */
	193	move.l 16(%a6), %a0 /* Save copy of Destination Address */
	194
6d0f6bcf	195	move.l #CONFIG_SYS_MONITOR_BASE, %a1
8e585f02 TL	196	move.l #__init_end, %a2
	197	move.l %a0, %a3
	198
	199	/* copy the code to RAM */
	200	1:
	201	move.l (%a1)+, (%a3)+
	202	cmp.l %a1,%a2
	203	bgt.s 1b
	204
	205	/*
	206	* We are done. Do not return, instead branch to second part of board
	207	* initialization, now running from RAM.
	208	*/
	209	move.l %a0, %a1
6d0f6bcf	210	add.l #(in_ram - CONFIG_SYS_MONITOR_BASE), %a1
8e585f02 TL	211	jmp (%a1)
	212
	213	in_ram:
	214
	215	clear_bss:
	216	/*
	217	* Now clear BSS segment
	218	*/
	219	move.l %a0, %a1
6d0f6bcf	220	add.l #(_sbss - CONFIG_SYS_MONITOR_BASE),%a1
8e585f02	221	move.l %a0, %d1
6d0f6bcf	222	add.l #(_ebss - CONFIG_SYS_MONITOR_BASE),%d1
8e585f02 TL	223	6:
	224	clr.l (%a1)+
	225	cmp.l %a1,%d1
	226	bgt.s 6b
	227
	228	/*
	229	* fix got table in RAM
	230	*/
	231	move.l %a0, %a1
6d0f6bcf	232	add.l #(__got_start - CONFIG_SYS_MONITOR_BASE),%a1
8e585f02 TL	233	move.l %a1,%a5 /* * fix got pointer register a5 */
	234
	235	move.l %a0, %a2
6d0f6bcf	236	add.l #(__got_end - CONFIG_SYS_MONITOR_BASE),%a2
8e585f02 TL	237
	238	7:
	239	move.l (%a1),%d1
	240	sub.l #_start,%d1
	241	add.l %a0,%d1
	242	move.l %d1,(%a1)+
	243	cmp.l %a2, %a1
	244	bne 7b
	245
	246	/* calculate relative jump to board_init_r in ram */
	247	move.l %a0, %a1
6d0f6bcf	248	add.l #(board_init_r - CONFIG_SYS_MONITOR_BASE), %a1
8e585f02 TL	249
	250	/* set parameters for board_init_r */
	251	move.l %a0,-(%sp) /* dest_addr */
	252	move.l %d0,-(%sp) /* gd */
	253	jsr (%a1)
	254
	255	/------------------------------------------------------------------------------/
	256	/* exception code */
	257	.globl _fault
	258	_fault:
	259	jmp _fault
	260	.globl _exc_handler
	261
	262	_exc_handler:
	263	SAVE_ALL
	264	movel %sp,%sp@-
	265	bsr exc_handler
	266	addql #4,%sp
	267	RESTORE_ALL
	268
	269	.globl _int_handler
	270	_int_handler:
	271	SAVE_ALL
	272	movel %sp,%sp@-
	273	bsr int_handler
	274	addql #4,%sp
	275	RESTORE_ALL
	276
	277	/------------------------------------------------------------------------------/
	278	/* cache functions */
	279	.globl icache_enable
	280	icache_enable:
	281	move.l #0x01000000, %d0 /* Invalidate cache cmd */
	282	movec %d0, %CACR /* Invalidate cache */
992d7129	283	move.l #(CONFIG_SYS_SDRAM_BASE + 0xc000 + ((CONFIG_SYS_SDRAM_SIZE & 0x1fe0) << 11)), %d0
8e585f02	284	movec %d0, %ACR0 /* Enable cache */
8e585f02	285
ddd104f1	286	move.l #0x80000200, %d0 /* Setup cache mask */
8e585f02	287	movec %d0, %CACR /* Enable cache */
ddd104f1	288	nop
8e585f02	289
6d0f6bcf	290	move.l #(CONFIG_SYS_INIT_RAM_ADDR+CONFIG_SYS_INIT_RAM_END-8), %a1
8e585f02 TL	291	moveq #1, %d0
	292	move.l %d0, (%a1)
	293	rts
	294
	295	.globl icache_disable
	296	icache_disable:
0dca874d T	297	move.l #0x01000000, %d0 /* Setup cache mask */
0dca874d T	298	movec %d0, %CACR /* Disable cache */
8e585f02	299	clr.l %d0 /* Setup cache mask */
0dca874d T	300	movec %d0, %ACR0
0dca874d T	301	movec %d0, %ACR1
8e585f02	302
6d0f6bcf	303	move.l #(CONFIG_SYS_INIT_RAM_ADDR+CONFIG_SYS_INIT_RAM_END-8), %a1
8e585f02 TL	304	moveq #0, %d0
	305	move.l %d0, (%a1)
	306	rts
	307
	308	.globl icache_status
	309	icache_status:
6d0f6bcf	310	move.l #(CONFIG_SYS_INIT_RAM_ADDR+CONFIG_SYS_INIT_RAM_END-8), %a1
8e585f02 TL	311	move.l (%a1), %d0
	312	rts
	313
	314	.globl icache_invalid
	315	icache_invalid:
0dca874d	316	move.l #0x81000200, %d0 /* Setup cache mask */
8e585f02 TL	317	movec %d0, %CACR /* Enable cache */
	318	rts
	319
	320	.globl dcache_enable
	321	dcache_enable:
6d0f6bcf	322	move.l #(CONFIG_SYS_INIT_RAM_ADDR+CONFIG_SYS_INIT_RAM_END-4), %a1
8e585f02 TL	323	moveq #1, %d0
	324	move.l %d0, (%a1)
	325	rts
	326
	327	/* No dcache, just a dummy function */
	328	.globl dcache_disable
	329	dcache_disable:
6d0f6bcf	330	move.l #(CONFIG_SYS_INIT_RAM_ADDR+CONFIG_SYS_INIT_RAM_END-4), %a1
8e585f02 TL	331	moveq #0, %d0
	332	move.l %d0, (%a1)
	333	rts
	334
	335	.globl dcache_status
	336	dcache_status:
6d0f6bcf	337	move.l #(CONFIG_SYS_INIT_RAM_ADDR+CONFIG_SYS_INIT_RAM_END-4), %a1
8e585f02 TL	338	move.l (%a1), %d0
	339	rts
	340
	341	/------------------------------------------------------------------------------/
	342
	343	.globl version_string
	344	version_string:
	345	.ascii U_BOOT_VERSION
561858ee	346	.ascii " (", U_BOOT_DATE, " - ", U_BOOT_TIME, ")"
8e585f02	347	.ascii CONFIG_IDENT_STRING, "\0"
9b46432f	348	.align 4