start.S 13 KB
Newer Older
1 2 3
/*
 *  armboot - Startup Code for OMP2420/ARM1136 CPU-core
 *
wdenk's avatar
wdenk committed
4
 *  Copyright (c) 2004	Texas Instruments <r-woodruff2@ti.com>
5 6 7
 *
 *  Copyright (c) 2001	Marius Grger <mag@sysgo.de>
 *  Copyright (c) 2002	Alex Zpke <azu@sysgo.de>
8
 *  Copyright (c) 2002	Gary Jennejohn <garyj@denx.de>
9 10 11 12 13 14 15 16 17 18 19 20 21
 *  Copyright (c) 2003	Richard Woodruff <r-woodruff2@ti.com>
 *  Copyright (c) 2003	Kshitij <kshitij@ti.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
wdenk's avatar
wdenk committed
22
 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.	 See the
23 24 25 26 27 28 29 30
 * 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
 */

31
#include <asm-offsets.h>
32 33 34
#include <config.h>
#include <version.h>
.globl _start
wdenk's avatar
wdenk committed
35
_start: b	reset
36
#ifdef CONFIG_PRELOADER
37 38 39 40 41 42 43 44 45 46 47 48 49 50 51 52 53 54
	ldr	pc, _hang
	ldr	pc, _hang
	ldr	pc, _hang
	ldr	pc, _hang
	ldr	pc, _hang
	ldr	pc, _hang
	ldr	pc, _hang

_hang:
	.word	do_hang
	.word	0x12345678
	.word	0x12345678
	.word	0x12345678
	.word	0x12345678
	.word	0x12345678
	.word	0x12345678
	.word	0x12345678	/* now 16*4=64 */
#else
55 56 57 58 59 60 61 62
	ldr	pc, _undefined_instruction
	ldr	pc, _software_interrupt
	ldr	pc, _prefetch_abort
	ldr	pc, _data_abort
	ldr	pc, _not_used
	ldr	pc, _irq
	ldr	pc, _fiq

wdenk's avatar
wdenk committed
63
_undefined_instruction: .word undefined_instruction
64 65 66 67 68 69
_software_interrupt:	.word software_interrupt
_prefetch_abort:	.word prefetch_abort
_data_abort:		.word data_abort
_not_used:		.word not_used
_irq:			.word irq
_fiq:			.word fiq
wdenk's avatar
wdenk committed
70
_pad:			.word 0x12345678 /* now 16*4=64 */
71
#endif	/* CONFIG_PRELOADER */
72 73 74 75 76 77 78 79 80 81 82 83 84 85 86 87 88
.global _end_vect
_end_vect:

	.balignl 16,0xdeadbeef
/*
 *************************************************************************
 *
 * Startup Code (reset vector)
 *
 * do important init only if we don't start from memory!
 * setup Memory and board specific bits prior to relocation.
 * relocate armboot to ram
 * setup stack
 *
 *************************************************************************
 */

89
.globl _TEXT_BASE
90
_TEXT_BASE:
91
	.word	CONFIG_SYS_TEXT_BASE
92 93 94

/*
 * These are defined in the board-specific linker script.
95 96 97
 * Subtracting _start from them lets the linker put their
 * relative position in the executable instead of leaving
 * them null.
98
 */
99 100 101
.globl _bss_start_ofs
_bss_start_ofs:
	.word __bss_start - _start
102

103 104 105
.globl _bss_end_ofs
_bss_end_ofs:
	.word _end - _start
106

107 108 109
.globl _datarel_start_ofs
_datarel_start_ofs:
	.word __datarel_start - _start
110

111 112 113
.globl _datarelrolocal_start_ofs
_datarelrolocal_start_ofs:
	.word __datarelrolocal_start - _start
114

115 116 117
.globl _datarellocal_start_ofs
_datarellocal_start_ofs:
	.word __datarellocal_start - _start
118

119 120 121
.globl _datarelro_start_ofs
_datarelro_start_ofs:
	.word __datarelro_start - _start
122

123 124 125 126 127 128 129 130 131 132 133 134
#ifdef CONFIG_USE_IRQ
/* IRQ stack memory (calculated at run-time) */
.globl IRQ_STACK_START
IRQ_STACK_START:
	.word	0x0badc0de

/* IRQ stack memory (calculated at run-time) */
.globl FIQ_STACK_START
FIQ_STACK_START:
	.word 0x0badc0de
#endif

135 136 137 138 139 140 141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 156 157 158 159 160 161 162 163 164 165 166 167 168 169 170 171 172 173 174 175 176 177 178 179 180 181 182 183 184 185 186 187 188 189 190 191 192 193 194 195 196 197 198 199 200 201 202 203 204 205 206 207 208 209 210 211 212
/* IRQ stack memory (calculated at run-time) + 8 bytes */
.globl IRQ_STACK_START_IN
IRQ_STACK_START_IN:
	.word	0x0badc0de

/*
 * the actual reset code
 */

reset:
	/*
	 * set the cpu to SVC32 mode
	 */
	mrs	r0,cpsr
	bic	r0,r0,#0x1f
	orr	r0,r0,#0xd3
	msr	cpsr,r0

#ifdef CONFIG_OMAP2420H4
       /* Copy vectors to mask ROM indirect addr */
	adr	r0, _start		/* r0 <- current position of code   */
		add     r0, r0, #4				/* skip reset vector			*/
	mov	r2, #64			/* r2 <- size to copy  */
	add	r2, r0, r2		/* r2 <- source end address	    */
	mov	r1, #SRAM_OFFSET0	  /* build vect addr */
	mov	r3, #SRAM_OFFSET1
	add	r1, r1, r3
	mov	r3, #SRAM_OFFSET2
	add	r1, r1, r3
next:
	ldmia	r0!, {r3-r10}		/* copy from source address [r0]    */
	stmia	r1!, {r3-r10}		/* copy to   target address [r1]    */
	cmp	r0, r2			/* until source end address [r2]    */
	bne	next			/* loop until equal */
	bl	cpy_clk_code		/* put dpll adjust code behind vectors */
#endif
	/* the mask ROM code should have PLL and others stable */
#ifndef CONFIG_SKIP_LOWLEVEL_INIT
	bl  cpu_init_crit
#endif

/* Set stackpointer in internal RAM to call board_init_f */
call_board_init_f:
	ldr	sp, =(CONFIG_SYS_INIT_SP_ADDR)
	ldr	r0,=0x00000000

#ifdef CONFIG_NAND_SPL
	bl	nand_boot
#else
#ifdef CONFIG_ONENAND_IPL
	bl	start_oneboot
#else
	bl	board_init_f
#endif /* CONFIG_ONENAND_IPL */
#endif /* CONFIG_NAND_SPL */

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

/*
 * void relocate_code (addr_sp, gd, addr_moni)
 *
 * This "function" does not return, instead it continues in RAM
 * after relocating the monitor code.
 *
 */
	.globl	relocate_code
relocate_code:
	mov	r4, r0	/* save addr_sp */
	mov	r5, r1	/* save addr of gd */
	mov	r6, r2	/* save addr of destination */
	mov	r7, r2	/* save addr of destination */

	/* Set up the stack						    */
stack_setup:
	mov	sp, r4

	adr	r0, _start
	ldr	r2, _TEXT_BASE
213 214
	ldr	r3, _bss_start_ofs
	add	r2, r0, r3		/* r2 <- source end address	    */
215 216 217 218 219 220
	cmp	r0, r6
	beq	clear_bss

copy_loop:
	ldmia	r0!, {r9-r10}		/* copy from source address [r0]    */
	stmia	r6!, {r9-r10}		/* copy to   target address [r1]    */
221 222
	cmp	r0, r2			/* until source end address [r2]    */
	blo	copy_loop
223 224

#ifndef CONFIG_PRELOADER
225 226 227 228 229 230 231 232 233 234 235
	/*
	 * fix .rel.dyn relocations
	 */
	ldr	r0, _TEXT_BASE		/* r0 <- Text base */
	sub	r9, r7, r0		/* r9 <- relocation offset */
	ldr	r10, _dynsym_start_ofs	/* r10 <- sym table ofs */
	add	r10, r10, r0		/* r10 <- sym table in FLASH */
	ldr	r2, _rel_dyn_start_ofs	/* r2 <- rel dyn start ofs */
	add	r2, r2, r0		/* r2 <- rel dyn start in FLASH */
	ldr	r3, _rel_dyn_end_ofs	/* r3 <- rel dyn end ofs */
	add	r3, r3, r0		/* r3 <- rel dyn end in FLASH */
236
fixloop:
237 238
	ldr	r0, [r2]		/* r0 <- location to fix up, IN FLASH! */
	add	r0, r0, r9		/* r0 <- location to fix up in RAM */
239 240
	ldr	r1, [r2, #4]
	and	r8, r1, #0xff
241
	cmp	r8, #23			/* relative fixup? */
242
	beq	fixrel
243
	cmp	r8, #2			/* absolute fixup? */
244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259
	beq	fixabs
	/* ignore unknown type of fixup */
	b	fixnext
fixabs:
	/* absolute fix: set location to (offset) symbol value */
	mov	r1, r1, LSR #4		/* r1 <- symbol index in .dynsym */
	add	r1, r10, r1		/* r1 <- address of symbol in table */
	ldr	r1, [r1, #4]		/* r1 <- symbol value */
	add	r1, r9			/* r1 <- relocated sym addr */
	b	fixnext
fixrel:
	/* relative fix: increase location by offset */
	ldr	r1, [r0]
	add	r1, r1, r9
fixnext:
	str	r1, [r0]
260
	add	r2, r2, #8		/* each rel.dyn entry is 8 bytes */
261
	cmp	r2, r3
262
	blo	fixloop
263 264 265 266
#endif

clear_bss:
#ifndef CONFIG_PRELOADER
267 268
	ldr	r0, _bss_start_ofs
	ldr	r1, _bss_end_ofs
269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285
	ldr	r3, _TEXT_BASE		/* Text base */
	mov	r4, r7			/* reloc addr */
	add	r0, r0, r4
	add	r1, r1, r4
	mov	r2, #0x00000000		/* clear			    */

clbss_l:str	r2, [r0]		/* clear loop...		    */
	add	r0, r0, #4
	cmp	r0, r1
	bne	clbss_l
#endif	/* #ifndef CONFIG_PRELOADER */

/*
 * We are done. Do not return, instead branch to second part of board
 * initialization, now running from RAM.
 */
#ifdef CONFIG_NAND_SPL
286 287 288 289 290
	ldr     r0, _nand_boot_ofs
	adr	r1, _start
	add	pc, r0, r1
_nand_boot_ofs
	: .word nand_boot - _start
291 292
#else
jump_2_ram:
293 294
	ldr	r0, _board_init_r_ofs
	adr	r1, _start
295 296
	add	lr, r0, r1
	add	lr, lr, r9
297 298 299 300 301 302
	/* setup parameters for board_init_r */
	mov	r0, r5		/* gd_t */
	mov	r1, r7		/* dest_addr */
	/* jump to it ... */
	mov	pc, lr

303 304
_board_init_r_ofs:
	.word board_init_r - _start
305
#endif
306 307 308 309 310 311 312 313

_rel_dyn_start_ofs:
	.word __rel_dyn_start - _start
_rel_dyn_end_ofs:
	.word __rel_dyn_end - _start
_dynsym_start_ofs:
	.word __dynsym_start - _start

314 315 316 317 318 319 320 321 322 323
/*
 *************************************************************************
 *
 * CPU_init_critical registers
 *
 * setup important registers
 * setup memory timing
 *
 *************************************************************************
 */
324
#ifndef CONFIG_SKIP_LOWLEVEL_INIT
325 326 327 328 329
cpu_init_crit:
	/*
	 * flush v4 I/D caches
	 */
	mov	r0, #0
330 331
	mcr	p15, 0, r0, c7, c7, 0	/* Invalidate I+D+BTB caches */
	mcr	p15, 0, r0, c8, c7, 0	/* Invalidate Unified TLB */
332 333 334 335 336 337 338 339 340 341 342 343

	/*
	 * disable MMU stuff and caches
	 */
	mrc	p15, 0, r0, c1, c0, 0
	bic	r0, r0, #0x00002300	@ clear bits 13, 9:8 (--V- --RS)
	bic	r0, r0, #0x00000087	@ clear bits 7, 2:0 (B--- -CAM)
	orr	r0, r0, #0x00000002	@ set bit 2 (A) Align
	orr	r0, r0, #0x00001000	@ set bit 12 (I) I-Cache
	mcr	p15, 0, r0, c1, c0, 0

	/*
wdenk's avatar
wdenk committed
344 345
	 * Jump to board specific initialization... The Mask ROM will have already initialized
	 * basic memory.  Go here to bump up clock rate and handle wake up conditions.
346
	 */
wdenk's avatar
wdenk committed
347
	mov	ip, lr		/* persevere link reg across call */
348
	bl	lowlevel_init	/* go setup pll,mux,memory */
wdenk's avatar
wdenk committed
349 350
	mov	lr, ip		/* restore link */
	mov	pc, lr		/* back to my caller */
351
#endif /* CONFIG_SKIP_LOWLEVEL_INIT */
352

353
#ifndef CONFIG_PRELOADER
354 355 356 357 358 359 360 361 362 363 364 365 366 367 368 369 370 371 372 373 374 375 376 377 378 379 380 381 382 383 384 385 386 387 388 389 390 391 392 393 394
/*
 *************************************************************************
 *
 * Interrupt handling
 *
 *************************************************************************
 */
@
@ IRQ stack frame.
@
#define S_FRAME_SIZE	72

#define S_OLD_R0	68
#define S_PSR		64
#define S_PC		60
#define S_LR		56
#define S_SP		52

#define S_IP		48
#define S_FP		44
#define S_R10		40
#define S_R9		36
#define S_R8		32
#define S_R7		28
#define S_R6		24
#define S_R5		20
#define S_R4		16
#define S_R3		12
#define S_R2		8
#define S_R1		4
#define S_R0		0

#define MODE_SVC 0x13
#define I_BIT	 0x80

/*
 * use bad_save_user_regs for abort/prefetch/undef/swi ...
 * use irq_save_user_regs / irq_restore_user_regs for IRQ/FIQ handling
 */

	.macro	bad_save_user_regs
wdenk's avatar
wdenk committed
395
	sub	sp, sp, #S_FRAME_SIZE		@ carve out a frame on current user stack
396 397
	stmia	sp, {r0 - r12}			@ Save user registers (now in svc mode) r0-r12

398
	ldr	r2, IRQ_STACK_START_IN		@ set base 2 words into abort stack
wdenk's avatar
wdenk committed
399
	ldmia	r2, {r2 - r3}			@ get values for "aborted" pc and cpsr (into parm regs)
400 401 402 403
	add	r0, sp, #S_FRAME_SIZE		@ grab pointer to old stack

	add	r5, sp, #S_SP
	mov	r1, lr
wdenk's avatar
wdenk committed
404 405
	stmia	r5, {r0 - r3}			@ save sp_SVC, lr_SVC, pc, cpsr
	mov	r0, sp				@ save current stack into r0 (param register)
406 407 408 409 410
	.endm

	.macro	irq_save_user_regs
	sub	sp, sp, #S_FRAME_SIZE
	stmia	sp, {r0 - r12}			@ Calling r0-r12
wdenk's avatar
wdenk committed
411 412 413 414 415 416
	add	r8, sp, #S_PC			@ !!!! R8 NEEDS to be saved !!!! a reserved stack spot would be good.
	stmdb	r8, {sp, lr}^			@ Calling SP, LR
	str	lr, [r8, #0]			@ Save calling PC
	mrs	r6, spsr
	str	r6, [r8, #4]			@ Save CPSR
	str	r0, [r8, #8]			@ Save OLD_R0
417 418 419 420 421 422 423 424 425 426 427 428
	mov	r0, sp
	.endm

	.macro	irq_restore_user_regs
	ldmia	sp, {r0 - lr}^			@ Calling r0 - lr
	mov	r0, r0
	ldr	lr, [sp, #S_PC]			@ Get PC
	add	sp, sp, #S_FRAME_SIZE
	subs	pc, lr, #4			@ return & move spsr_svc into cpsr
	.endm

	.macro get_bad_stack
429
	ldr	r13, IRQ_STACK_START_IN		@ setup our mode stack (enter in banked mode)
430 431

	str	lr, [r13]			@ save caller lr in position 0 of saved stack
wdenk's avatar
wdenk committed
432 433
	mrs	lr, spsr			@ get the spsr
	str	lr, [r13, #4]			@ save spsr in position 1 of saved stack
434 435 436

	mov	r13, #MODE_SVC			@ prepare SVC-Mode
	@ msr	spsr_c, r13
wdenk's avatar
wdenk committed
437 438 439
	msr	spsr, r13			@ switch modes, make sure moves will execute
	mov	lr, pc				@ capture return pc
	movs	pc, lr				@ jump to next instruction & switch modes.
440 441 442
	.endm

	.macro get_bad_stack_swi
wdenk's avatar
wdenk committed
443 444
	sub	r13, r13, #4			@ space on current stack for scratch reg.
	str	r0, [r13]			@ save R0's value.
445
	ldr	r0, IRQ_STACK_START_IN		@ get data regions start
446
	str	lr, [r0]			@ save caller lr in position 0 of saved stack
wdenk's avatar
wdenk committed
447 448 449 450
	mrs	r0, spsr			@ get the spsr
	str	lr, [r0, #4]			@ save spsr in position 1 of saved stack
	ldr	r0, [r13]			@ restore r0
	add	r13, r13, #4			@ pop stack entry
451 452 453 454 455 456 457 458 459
	.endm

	.macro get_irq_stack			@ setup IRQ stack
	ldr	sp, IRQ_STACK_START
	.endm

	.macro get_fiq_stack			@ setup FIQ stack
	ldr	sp, FIQ_STACK_START
	.endm
460
#endif	/* CONFIG_PRELOADER */
461 462 463 464

/*
 * exception handlers
 */
465
#ifdef CONFIG_PRELOADER
466 467 468 469
	.align	5
do_hang:
	ldr	sp, _TEXT_BASE			/* use 32 words about stack */
	bl	hang				/* hang and never return */
470
#else	/* !CONFIG_PRELOADER */
wdenk's avatar
wdenk committed
471
	.align	5
472 473 474
undefined_instruction:
	get_bad_stack
	bad_save_user_regs
wdenk's avatar
wdenk committed
475
	bl	do_undefined_instruction
476 477 478 479 480

	.align	5
software_interrupt:
	get_bad_stack_swi
	bad_save_user_regs
wdenk's avatar
wdenk committed
481
	bl	do_software_interrupt
482 483 484 485 486

	.align	5
prefetch_abort:
	get_bad_stack
	bad_save_user_regs
wdenk's avatar
wdenk committed
487
	bl	do_prefetch_abort
488 489 490 491 492

	.align	5
data_abort:
	get_bad_stack
	bad_save_user_regs
wdenk's avatar
wdenk committed
493
	bl	do_data_abort
494 495 496 497 498

	.align	5
not_used:
	get_bad_stack
	bad_save_user_regs
wdenk's avatar
wdenk committed
499
	bl	do_not_used
500 501 502 503 504 505 506

#ifdef CONFIG_USE_IRQ

	.align	5
irq:
	get_irq_stack
	irq_save_user_regs
wdenk's avatar
wdenk committed
507
	bl	do_irq
508 509 510 511 512 513 514
	irq_restore_user_regs

	.align	5
fiq:
	get_fiq_stack
	/* someone ought to write a more effiction fiq_save_user_regs */
	irq_save_user_regs
wdenk's avatar
wdenk committed
515
	bl	do_fiq
516 517 518 519 520 521 522 523
	irq_restore_user_regs

#else

	.align	5
irq:
	get_bad_stack
	bad_save_user_regs
wdenk's avatar
wdenk committed
524
	bl	do_irq
525 526 527 528 529

	.align	5
fiq:
	get_bad_stack
	bad_save_user_regs
wdenk's avatar
wdenk committed
530
	bl	do_fiq
531 532 533 534 535

#endif
	.align 5
.global arm1136_cache_flush
arm1136_cache_flush:
536
#if !defined(CONFIG_SYS_NO_ICACHE)
537
		mcr	p15, 0, r1, c7, c5, 0	@ invalidate I cache
538 539 540 541
#endif
#if !defined(CONFIG_SYS_NO_DCACHE)
		mcr	p15, 0, r1, c7, c14, 0	@ invalidate D cache
#endif
542
		mov	pc, lr			@ back to caller
543
#endif	/* CONFIG_PRELOADER */