1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34#include <config.h>
35#include <version.h>
36
37
38
39
40
41
42
43
44
45
46.globl _start
47_start:
48 b reset
49 ldr pc, _undefined_instruction
50 ldr pc, _software_interrupt
51 ldr pc, _prefetch_abort
52 ldr pc, _data_abort
53 ldr pc, _not_used
54 ldr pc, _irq
55 ldr pc, _fiq
56
57_undefined_instruction:
58 .word undefined_instruction
59_software_interrupt:
60 .word software_interrupt
61_prefetch_abort:
62 .word prefetch_abort
63_data_abort:
64 .word data_abort
65_not_used:
66 .word not_used
67_irq:
68 .word irq
69_fiq:
70 .word fiq
71
72 .balignl 16,0xdeadbeef
73
74
75
76
77
78
79
80
81
82
83
84
85
86
87
88_TEXT_BASE:
89 .word TEXT_BASE
90
91.globl _armboot_start
92_armboot_start:
93 .word _start
94
95
96
97
98.globl _bss_start
99_bss_start:
100 .word __bss_start
101
102.globl _bss_end
103_bss_end:
104 .word _end
105
106#ifdef CONFIG_USE_IRQ
107
108.globl IRQ_STACK_START
109IRQ_STACK_START:
110 .word 0x0badc0de
111
112
113.globl FIQ_STACK_START
114FIQ_STACK_START:
115 .word 0x0badc0de
116#endif
117
118
119
120
121
122
123reset:
124
125
126
127 mrs r0,cpsr
128 bic r0,r0,
129 orr r0,r0,
130 msr cpsr,r0
131
132
133
134
135
136#ifndef CONFIG_SKIP_LOWLEVEL_INIT
137 bl cpu_init_crit
138#endif
139
140relocate:
141 adr r0, _start
142 ldr r1, _TEXT_BASE
143 cmp r0, r1
144 beq stack_setup
145
146 ldr r2, _armboot_start
147 ldr r3, _bss_start
148 sub r2, r3, r2
149 add r2, r0, r2
150
151copy_loop:
152 ldmia r0!, {r3-r10}
153 stmia r1!, {r3-r10}
154 cmp r0, r2
155 ble copy_loop
156
157
158stack_setup:
159 ldr r0, _TEXT_BASE
160 sub r0, r0,
161 sub r0, r0,
162#ifdef CONFIG_USE_IRQ
163 sub r0, r0,
164#endif
165 sub sp, r0,
166 bic sp, sp,
167
168clear_bss:
169 ldr r0, _bss_start
170 ldr r1, _bss_end
171 mov r2,
172
173clbss_l:str r2, [r0]
174 add r0, r0,
175 cmp r0, r1
176 bne clbss_l
177
178 ldr pc, _start_armboot
179
180_start_armboot:
181 .word start_armboot
182
183
184
185
186
187
188
189
190
191
192
193
194
195
196#ifndef CONFIG_SKIP_LOWLEVEL_INIT
197cpu_init_crit:
198
199
200
201 mov r0,
202 mcr p15, 0, r0, c7, c5, 0
203 mcr p15, 0, r0, c7, c6, 0
204
205
206
207
208 mrc p15, 0, r0, c1, c0, 0
209 bic r0, r0,
210 bic r0, r0,
211 orr r0, r0,
212 orr r0, r0,
213 mcr p15, 0, r0, c1, c0, 0
214
215
216
217
218 mov ip, lr
219 bl lowlevel_init
220 mov lr, ip
221 mov pc, lr
222#endif
223
224
225
226
227
228
229
230
231@
232@ IRQ stack frame.
233@
234#define S_FRAME_SIZE 72
235
236#define S_OLD_R0 68
237#define S_PSR 64
238#define S_PC 60
239#define S_LR 56
240#define S_SP 52
241
242#define S_IP 48
243#define S_FP 44
244#define S_R10 40
245#define S_R9 36
246#define S_R8 32
247#define S_R7 28
248#define S_R6 24
249#define S_R5 20
250#define S_R4 16
251#define S_R3 12
252#define S_R2 8
253#define S_R1 4
254#define S_R0 0
255
256#define MODE_SVC 0x13
257#define I_BIT 0x80
258
259
260
261
262
263
264 .macro bad_save_user_regs
265 @ carve out a frame on current user stack
266 sub sp, sp,
267 stmia sp, {r0 - r12} @ Save user registers (now in svc mode) r0-r12
268
269 ldr r2, _armboot_start
270 sub r2, r2,
271 sub r2, r2,
272 @ get values for "aborted" pc and cpsr (into parm regs)
273 ldmia r2, {r2 - r3}
274 add r0, sp,
275 add r5, sp,
276 mov r1, lr
277 stmia r5, {r0 - r3} @ save sp_SVC, lr_SVC, pc, cpsr
278 mov r0, sp @ save current stack into r0 (param register)
279 .endm
280
281 .macro irq_save_user_regs
282 sub sp, sp,
283 stmia sp, {r0 - r12} @ Calling r0-r12
284 @ !!!! R8 NEEDS to be saved !!!! a reserved stack spot would be good.
285 add r8, sp,
286 stmdb r8, {sp, lr}^ @ Calling SP, LR
287 str lr, [r8,
288 mrs r6, spsr
289 str r6, [r8,
290 str r0, [r8,
291 mov r0, sp
292 .endm
293
294 .macro irq_restore_user_regs
295 ldmia sp, {r0 - lr}^ @ Calling r0 - lr
296 mov r0, r0
297 ldr lr, [sp,
298 add sp, sp,
299 subs pc, lr,
300 .endm
301
302 .macro get_bad_stack
303 ldr r13, _armboot_start @ setup our mode stack
304 sub r13, r13,
305 sub r13, r13,
306
307 str lr, [r13] @ save caller lr in position 0 of saved stack
308 mrs lr, spsr @ get the spsr
309 str lr, [r13,
310 mov r13,
311 @ msr spsr_c, r13
312 msr spsr, r13 @ switch modes, make sure moves will execute
313 mov lr, pc @ capture return pc
314 movs pc, lr @ jump to next instruction & switch modes.
315 .endm
316
317 .macro get_irq_stack @ setup IRQ stack
318 ldr sp, IRQ_STACK_START
319 .endm
320
321 .macro get_fiq_stack @ setup FIQ stack
322 ldr sp, FIQ_STACK_START
323 .endm
324
325
326
327
328 .align 5
329undefined_instruction:
330 get_bad_stack
331 bad_save_user_regs
332 bl do_undefined_instruction
333
334 .align 5
335software_interrupt:
336 get_bad_stack
337 bad_save_user_regs
338 bl do_software_interrupt
339
340 .align 5
341prefetch_abort:
342 get_bad_stack
343 bad_save_user_regs
344 bl do_prefetch_abort
345
346 .align 5
347data_abort:
348 get_bad_stack
349 bad_save_user_regs
350 bl do_data_abort
351
352 .align 5
353not_used:
354 get_bad_stack
355 bad_save_user_regs
356 bl do_not_used
357
358#ifdef CONFIG_USE_IRQ
359
360 .align 5
361irq:
362 get_irq_stack
363 irq_save_user_regs
364 bl do_irq
365 irq_restore_user_regs
366
367 .align 5
368fiq:
369 get_fiq_stack
370
371 irq_save_user_regs
372 bl do_fiq
373 irq_restore_user_regs
374
375#else
376
377 .align 5
378irq:
379 get_bad_stack
380 bad_save_user_regs
381 bl do_irq
382
383 .align 5
384fiq:
385 get_bad_stack
386 bad_save_user_regs
387 bl do_fiq
388
389#endif
390
391# ifdef CONFIG_INTEGRATOR
392
393
394
395#else
396
397 .align 5
398.globl reset_cpu
399reset_cpu:
400
401 ldr r1, rstctl1
402 mov r3,
403 strh r3, [r1]
404 mov r3,
405 strh r3, [r1]
406_loop_forever:
407 b _loop_forever
408
409rstctl1:
410 .word 0xfffece10
411
412#endif
413