Blame view
arch/arm/cpu/arm_intcm/start.S
9.36 KB
74f4304ee Add ARM946E cpu a... |
1 2 3 4 5 6 7 |
/* * armboot - Startup Code for ARM926EJS CPU-core * * Copyright (c) 2003 Texas Instruments * * ----- Adapted for OMAP1610 OMAP730 from ARM925t code ------ * |
fa82f871c Convert ISO-8859 ... |
8 9 |
* Copyright (c) 2001 Marius Gröger <mag@sysgo.de> * Copyright (c) 2002 Alex Züpke <azu@sysgo.de> |
792a09eb9 Fix e-mail addres... |
10 |
* Copyright (c) 2002 Gary Jennejohn <garyj@denx.de> |
74f4304ee Add ARM946E cpu a... |
11 12 13 14 15 16 17 18 19 20 21 22 23 24 25 26 27 28 29 30 31 |
* 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 * 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 */ |
25ddd1fb0 Replace CONFIG_SY... |
32 |
#include <asm-offsets.h> |
74f4304ee Add ARM946E cpu a... |
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 59 60 61 62 63 64 65 66 67 68 69 70 71 72 73 74 75 76 77 78 79 80 81 82 83 |
#include <config.h> #include <version.h> /* ************************************************************************* * * Jump vector table * ************************************************************************* */ .globl _start _start: b reset 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 _undefined_instruction: .word undefined_instruction _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 .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 * ************************************************************************* */ |
c6c2ceb12 ARM: implement re... |
84 |
.globl _TEXT_BASE |
74f4304ee Add ARM946E cpu a... |
85 |
_TEXT_BASE: |
14d0a02a1 Rename TEXT_BASE ... |
86 |
.word CONFIG_SYS_TEXT_BASE /* address of _start in the linked image */ |
74f4304ee Add ARM946E cpu a... |
87 |
|
74f4304ee Add ARM946E cpu a... |
88 89 |
/* * These are defined in the board-specific linker script. |
3336ca60d arm: add ELF relo... |
90 91 92 |
* Subtracting _start from them lets the linker put their * relative position in the executable instead of leaving * them null. |
74f4304ee Add ARM946E cpu a... |
93 |
*/ |
3336ca60d arm: add ELF relo... |
94 95 96 |
.globl _bss_start_ofs _bss_start_ofs: .word __bss_start - _start |
74f4304ee Add ARM946E cpu a... |
97 |
|
3336ca60d arm: add ELF relo... |
98 99 |
.globl _bss_end_ofs _bss_end_ofs: |
44c6e6591 rename _end to __... |
100 |
.word __bss_end__ - _start |
74f4304ee Add ARM946E cpu a... |
101 |
|
f326cbba9 arm: fix incorrec... |
102 103 104 |
.globl _end_ofs _end_ofs: .word _end - _start |
74f4304ee Add ARM946E cpu a... |
105 106 107 108 109 110 111 112 113 114 115 |
#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 |
c6c2ceb12 ARM: implement re... |
116 117 118 119 |
/* IRQ stack memory (calculated at run-time) + 8 bytes */ .globl IRQ_STACK_START_IN IRQ_STACK_START_IN: .word 0x0badc0de |
c6c2ceb12 ARM: implement re... |
120 121 122 123 124 125 126 127 128 129 130 131 132 133 134 135 136 137 138 139 |
/* * 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 /* * we do sys-critical inits only at reboot, * not when booting from ram! */ #ifndef CONFIG_SKIP_LOWLEVEL_INIT bl cpu_init_crit #endif |
e05e5de7f arm: move C runti... |
140 |
bl _main |
c6c2ceb12 ARM: implement re... |
141 142 143 144 145 146 147 148 149 150 151 152 153 154 155 |
/*------------------------------------------------------------------------------*/ /* * 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 */ |
c6c2ceb12 ARM: implement re... |
156 |
|
c6c2ceb12 ARM: implement re... |
157 |
adr r0, _start |
a1a47d3c5 arm: relocate_cod... |
158 |
cmp r0, r6 |
76abfa578 arm: Fixed the of... |
159 |
moveq r9, #0 /* no relocation. relocation offset(r9) = 0 */ |
e05e5de7f arm: move C runti... |
160 |
beq relocate_done /* skip relocation */ |
a78fb68f7 arm: copy_loop():... |
161 |
mov r1, r6 /* r1 <- scratch for copy_loop */ |
3336ca60d arm: add ELF relo... |
162 163 |
ldr r3, _bss_start_ofs add r2, r0, r3 /* r2 <- source end address */ |
c6c2ceb12 ARM: implement re... |
164 |
|
c6c2ceb12 ARM: implement re... |
165 166 |
copy_loop: ldmia r0!, {r9-r10} /* copy from source address [r0] */ |
a78fb68f7 arm: copy_loop():... |
167 |
stmia r1!, {r9-r10} /* copy to target address [r1] */ |
da90d4ce3 arm: bugfix: repl... |
168 169 |
cmp r0, r2 /* until source end address [r2] */ blo copy_loop |
c6c2ceb12 ARM: implement re... |
170 |
|
401bb30b6 replace CONFIG_PR... |
171 |
#ifndef CONFIG_SPL_BUILD |
3336ca60d arm: add ELF relo... |
172 173 174 175 |
/* * fix .rel.dyn relocations */ ldr r0, _TEXT_BASE /* r0 <- Text base */ |
a78fb68f7 arm: copy_loop():... |
176 |
sub r9, r6, r0 /* r9 <- relocation offset */ |
3336ca60d arm: add ELF relo... |
177 178 179 180 181 182 |
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 */ |
c6c2ceb12 ARM: implement re... |
183 |
fixloop: |
3336ca60d arm: add ELF relo... |
184 185 186 |
ldr r0, [r2] /* r0 <- location to fix up, IN FLASH! */ add r0, r0, r9 /* r0 <- location to fix up in RAM */ ldr r1, [r2, #4] |
1f52d89f2 arm: fixloop(): d... |
187 188 |
and r7, r1, #0xff cmp r7, #23 /* relative fixup? */ |
3336ca60d arm: add ELF relo... |
189 |
beq fixrel |
1f52d89f2 arm: fixloop(): d... |
190 |
cmp r7, #2 /* absolute fixup? */ |
3336ca60d arm: add ELF relo... |
191 192 193 194 195 196 197 198 |
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 */ |
3600945b5 ARM: */start.S: u... |
199 |
add r1, r1, r9 /* r1 <- relocated sym addr */ |
3336ca60d arm: add ELF relo... |
200 201 202 203 204 205 206 207 |
b fixnext fixrel: /* relative fix: increase location by offset */ ldr r1, [r0] add r1, r1, r9 fixnext: str r1, [r0] add r2, r2, #8 /* each rel.dyn entry is 8 bytes */ |
c6c2ceb12 ARM: implement re... |
208 |
cmp r2, r3 |
79e631393 ARM: use the same... |
209 |
blo fixloop |
c6c2ceb12 ARM: implement re... |
210 |
#endif |
c6c2ceb12 ARM: implement re... |
211 |
|
e05e5de7f arm: move C runti... |
212 |
relocate_done: |
c6c2ceb12 ARM: implement re... |
213 |
|
e05e5de7f arm: move C runti... |
214 |
bx lr |
3336ca60d arm: add ELF relo... |
215 216 217 218 219 220 221 |
_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 |
c6c2ceb12 ARM: implement re... |
222 |
|
e05e5de7f arm: move C runti... |
223 224 225 226 |
.globl c_runtime_cpu_setup c_runtime_cpu_setup: mov pc, lr |
74f4304ee Add ARM946E cpu a... |
227 228 229 230 231 232 233 234 235 236 |
/* ************************************************************************* * * CPU_init_critical registers * * setup important registers * setup memory timing * ************************************************************************* */ |
8fc3bb4b0 arm: cleanup rema... |
237 |
#ifndef CONFIG_SKIP_LOWLEVEL_INIT |
74f4304ee Add ARM946E cpu a... |
238 239 240 241 242 |
cpu_init_crit: /* arm_int_generic assumes the ARM boot monitor, or user software, * has initialized the platform */ mov pc, lr /* back to my caller */ |
8fc3bb4b0 arm: cleanup rema... |
243 |
#endif |
74f4304ee Add ARM946E cpu a... |
244 245 246 247 248 249 250 251 252 253 254 255 256 257 258 259 260 261 262 263 264 265 266 267 268 269 270 271 272 273 274 275 276 277 278 279 280 281 282 283 284 285 286 287 288 |
/* ************************************************************************* * * 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 @ carve out a frame on current user stack sub sp, sp, #S_FRAME_SIZE stmia sp, {r0 - r12} @ Save user registers (now in svc mode) r0-r12 |
c6c2ceb12 ARM: implement re... |
289 |
ldr r2, IRQ_STACK_START_IN |
74f4304ee Add ARM946E cpu a... |
290 291 292 293 294 295 296 297 298 299 300 301 302 303 304 305 306 307 308 309 310 311 312 313 314 315 316 317 318 319 320 |
@ get values for "aborted" pc and cpsr (into parm regs) ldmia r2, {r2 - r3} add r0, sp, #S_FRAME_SIZE @ grab pointer to old stack add r5, sp, #S_SP mov r1, lr stmia r5, {r0 - r3} @ save sp_SVC, lr_SVC, pc, cpsr mov r0, sp @ save current stack into r0 (param register) .endm .macro irq_save_user_regs sub sp, sp, #S_FRAME_SIZE stmia sp, {r0 - r12} @ Calling r0-r12 @ !!!! R8 NEEDS to be saved !!!! a reserved stack spot would be good. add r8, sp, #S_PC 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 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 |
c6c2ceb12 ARM: implement re... |
321 |
ldr r13, IRQ_STACK_START_IN @ setup our mode stack |
74f4304ee Add ARM946E cpu a... |
322 323 324 325 326 327 328 329 330 331 332 333 334 335 336 337 338 339 340 341 342 343 344 345 346 347 348 349 350 351 352 353 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 |
str lr, [r13] @ save caller lr in position 0 of saved stack mrs lr, spsr @ get the spsr str lr, [r13, #4] @ save spsr in position 1 of saved stack mov r13, #MODE_SVC @ prepare SVC-Mode @ msr spsr_c, r13 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. .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 /* * exception handlers */ .align 5 .globl undefined_instruction undefined_instruction: get_bad_stack bad_save_user_regs bl do_undefined_instruction .align 5 .globl software_interrupt software_interrupt: get_bad_stack bad_save_user_regs bl do_software_interrupt .align 5 .globl prefetch_abort prefetch_abort: get_bad_stack bad_save_user_regs bl do_prefetch_abort .align 5 .globl data_abort data_abort: get_bad_stack bad_save_user_regs bl do_data_abort .align 5 .globl not_used not_used: get_bad_stack bad_save_user_regs bl do_not_used #ifdef CONFIG_USE_IRQ .align 5 .globl irq irq: get_irq_stack irq_save_user_regs |
53677ef18 Big white-space c... |
385 |
bl do_irq |
74f4304ee Add ARM946E cpu a... |
386 387 388 389 390 391 392 393 |
irq_restore_user_regs .align 5 .globl fiq fiq: get_fiq_stack /* someone ought to write a more effiction fiq_save_user_regs */ irq_save_user_regs |
53677ef18 Big white-space c... |
394 |
bl do_fiq |
74f4304ee Add ARM946E cpu a... |
395 396 397 398 399 |
irq_restore_user_regs #else .align 5 |
fe7eb5d88 Cleanup |
400 |
.globl irq |
74f4304ee Add ARM946E cpu a... |
401 402 403 404 405 406 |
irq: get_bad_stack bad_save_user_regs bl do_irq .align 5 |
fe7eb5d88 Cleanup |
407 |
.globl fiq |
74f4304ee Add ARM946E cpu a... |
408 409 410 411 412 413 |
fiq: get_bad_stack bad_save_user_regs bl do_fiq #endif |