2 * armboot - Startup Code for XScale CPU-core
4 * Copyright (C) 1998 Dan Malek <dmalek@jlc.net>
5 * Copyright (C) 1999 Magnus Damm <kieraypc01.p.y.kie.era.ericsson.se>
6 * Copyright (C) 2000 Wolfgang Denk <wd@denx.de>
7 * Copyright (C) 2001 Alex Zuepke <azu@sysgo.de>
8 * Copyright (C) 2001 Marius Groger <mag@sysgo.de>
9 * Copyright (C) 2002 Alex Zupke <azu@sysgo.de>
10 * Copyright (C) 2002 Gary Jennejohn <garyj@denx.de>
11 * Copyright (C) 2002 Kyle Harris <kharris@nexus-tech.net>
12 * Copyright (C) 2003 Kai-Uwe Bloem <kai-uwe.bloem@auerswald.de>
13 * Copyright (C) 2003 Kshitij <kshitij@ti.com>
14 * Copyright (C) 2003 Richard Woodruff <r-woodruff2@ti.com>
15 * Copyright (C) 2003 Robert Schwebel <r.schwebel@pengutronix.de>
16 * Copyright (C) 2004 Texas Instruments <r-woodruff2@ti.com>
17 * Copyright (C) 2010 Marek Vasut <marek.vasut@gmail.com>
19 * SPDX-License-Identifier: GPL-2.0+
22 #include <asm-offsets.h>
28 #ifdef CONFIG_SPL_BUILD
45 .word 0x12345678 /* now 16*4=64 */
47 ldr pc, _undefined_instruction
48 ldr pc, _software_interrupt
49 ldr pc, _prefetch_abort
55 _undefined_instruction: .word undefined_instruction
56 _software_interrupt: .word software_interrupt
57 _prefetch_abort: .word prefetch_abort
58 _data_abort: .word data_abort
59 _not_used: .word not_used
62 _pad: .word 0x12345678 /* now 16*4=64 */
63 #endif /* CONFIG_SPL_BUILD */
67 .balignl 16,0xdeadbeef
69 *************************************************************************
71 * Startup Code (reset vector)
73 * do important init only if we don't start from memory!
74 * setup Memory and board specific bits prior to relocation.
75 * relocate armboot to ram
78 *************************************************************************
82 /* IRQ stack memory (calculated at run-time) */
83 .globl IRQ_STACK_START
87 /* IRQ stack memory (calculated at run-time) */
88 .globl FIQ_STACK_START
93 /* IRQ stack memory (calculated at run-time) + 8 bytes */
94 .globl IRQ_STACK_START_IN
99 * the actual reset code
104 * set the cpu to SVC32 mode
111 #ifndef CONFIG_SKIP_LOWLEVEL_INIT
115 #ifdef CONFIG_CPU_PXA25X
116 bl lock_cache_for_stack
121 /*------------------------------------------------------------------------------*/
123 .globl c_runtime_cpu_setup
126 #ifdef CONFIG_CPU_PXA25X
128 * Unlock (actually, disable) the cache now that board_init_f
129 * is done. We could do this earlier but we would need to add
130 * a new C runtime hook, whereas c_runtime_cpu_setup already
132 * As this routine is just a call to cpu_init_crit, let us
133 * tail-optimize and do a simple branch here.
141 *************************************************************************
143 * CPU_init_critical registers
145 * setup important registers
146 * setup memory timing
148 *************************************************************************
150 #if !defined(CONFIG_SKIP_LOWLEVEL_INIT) || defined(CONFIG_CPU_PXA25X)
153 * flush v4 I/D caches
156 mcr p15, 0, r0, c7, c7, 0 /* Invalidate I+D+BTB caches */
157 mcr p15, 0, r0, c8, c7, 0 /* Invalidate Unified TLB */
160 * disable MMU stuff and caches
162 mrc p15, 0, r0, c1, c0, 0
163 bic r0, r0, #0x00003300 @ clear bits 13:12, 9:8 (--VI --RS)
164 bic r0, r0, #0x00000087 @ clear bits 7, 2:0 (B--- -CAM)
165 orr r0, r0, #0x00000002 @ set bit 2 (A) Align
166 mcr p15, 0, r0, c1, c0, 0
168 mov pc, lr /* back to my caller */
169 #endif /* !CONFIG_SKIP_LOWLEVEL_INIT || CONFIG_CPU_PXA25X */
171 #ifndef CONFIG_SPL_BUILD
173 *************************************************************************
177 *************************************************************************
182 #define S_FRAME_SIZE 72
204 #define MODE_SVC 0x13
208 * use bad_save_user_regs for abort/prefetch/undef/swi ...
209 * use irq_save_user_regs / irq_restore_user_regs for IRQ/FIQ handling
212 .macro bad_save_user_regs
213 sub sp, sp, #S_FRAME_SIZE @ carve out a frame on current user stack
214 stmia sp, {r0 - r12} @ Save user registers (now in svc mode) r0-r12
216 ldr r2, IRQ_STACK_START_IN @ set base 2 words into abort stack
217 ldmia r2, {r2 - r3} @ get values for "aborted" pc and cpsr (into parm regs)
218 add r0, sp, #S_FRAME_SIZE @ grab pointer to old stack
222 stmia r5, {r0 - r3} @ save sp_SVC, lr_SVC, pc, cpsr
223 mov r0, sp @ save current stack into r0 (param register)
226 .macro irq_save_user_regs
227 sub sp, sp, #S_FRAME_SIZE
228 stmia sp, {r0 - r12} @ Calling r0-r12
229 add r8, sp, #S_PC @ !!!! R8 NEEDS to be saved !!!! a reserved stack spot would be good.
230 stmdb r8, {sp, lr}^ @ Calling SP, LR
231 str lr, [r8, #0] @ Save calling PC
233 str r6, [r8, #4] @ Save CPSR
234 str r0, [r8, #8] @ Save OLD_R0
238 .macro irq_restore_user_regs
239 ldmia sp, {r0 - lr}^ @ Calling r0 - lr
241 ldr lr, [sp, #S_PC] @ Get PC
242 add sp, sp, #S_FRAME_SIZE
243 subs pc, lr, #4 @ return & move spsr_svc into cpsr
247 ldr r13, IRQ_STACK_START_IN @ setup our mode stack (enter in banked mode)
249 str lr, [r13] @ save caller lr in position 0 of saved stack
250 mrs lr, spsr @ get the spsr
251 str lr, [r13, #4] @ save spsr in position 1 of saved stack
253 mov r13, #MODE_SVC @ prepare SVC-Mode
255 msr spsr, r13 @ switch modes, make sure moves will execute
256 mov lr, pc @ capture return pc
257 movs pc, lr @ jump to next instruction & switch modes.
260 .macro get_bad_stack_swi
261 sub r13, r13, #4 @ space on current stack for scratch reg.
262 str r0, [r13] @ save R0's value.
263 ldr r0, IRQ_STACK_START_IN @ get data regions start
264 str lr, [r0] @ save caller lr in position 0 of saved stack
265 mrs lr, spsr @ get the spsr
266 str lr, [r0, #4] @ save spsr in position 1 of saved stack
267 ldr lr, [r0] @ restore lr
268 ldr r0, [r13] @ restore r0
269 add r13, r13, #4 @ pop stack entry
272 .macro get_irq_stack @ setup IRQ stack
273 ldr sp, IRQ_STACK_START
276 .macro get_fiq_stack @ setup FIQ stack
277 ldr sp, FIQ_STACK_START
279 #endif /* CONFIG_SPL_BUILD */
284 #ifdef CONFIG_SPL_BUILD
287 bl hang /* hang and never return */
288 #else /* !CONFIG_SPL_BUILD */
290 undefined_instruction:
293 bl do_undefined_instruction
299 bl do_software_interrupt
319 #ifdef CONFIG_USE_IRQ
326 irq_restore_user_regs
331 /* someone ought to write a more effiction fiq_save_user_regs */
334 irq_restore_user_regs
352 #endif /* CONFIG_SPL_BUILD */
356 * Enable MMU to use DCache as DRAM.
358 * This is useful on PXA25x and PXA26x in early bootstages, where there is no
359 * other possible memory available to hold stack.
361 #ifdef CONFIG_CPU_PXA25X
363 mrc p15, 0, \reg, c2, c0, 0
367 lock_cache_for_stack:
368 /* Domain access -- enable for all CPs */
370 mcr p15, 0, r0, c3, c0, 0
372 /* Point TTBR to MMU table */
374 mcr p15, 0, r0, c2, c0, 0
376 /* Kick in MMU, ICache, DCache, BTB */
377 mrc p15, 0, r0, c1, c0, 0
382 mcr p15, 0, r0, c1, c0, 0
385 /* Unlock Icache, Dcache */
386 mcr p15, 0, r0, c9, c1, 1
387 mcr p15, 0, r0, c9, c2, 1
389 /* Flush Icache, Dcache, BTB */
390 mcr p15, 0, r0, c7, c7, 0
392 /* Unlock I-TLB, D-TLB */
393 mcr p15, 0, r0, c10, c4, 1
394 mcr p15, 0, r0, c10, c8, 1
397 mcr p15, 0, r0, c8, c7, 0
399 /* Allocate 4096 bytes of Dcache as RAM */
401 /* Drain pending loads and stores */
402 mcr p15, 0, r0, c7, c10, 4
407 mcr p15, 0, r0, c9, c2, 0
410 /* 128 lines reserved (128 x 32bytes = 4096 bytes total) */
415 mcr p15, 0, r1, c7, c2, 5
416 /* Drain pending loads and stores */
417 mcr p15, 0, r0, c7, c10, 4
424 /* Drain pending loads and stores */
425 mcr p15, 0, r0, c7, c10, 4
427 mcr p15, 0, r2, c9, c2, 0
432 .section .mmutable, "a"
435 /* 0x00000000 - 0xffe00000 : 1:1, uncached mapping */
438 .word (__base << 20) | 0xc12
439 .set __base, __base + 1
442 /* 0xfff00000 : 1:1, cached mapping */
443 .word (0xfff << 20) | 0x1c1e
444 #endif /* CONFIG_CPU_PXA25X */