1
2
3
4
5
6
7
8
9
10
11
12
13
14#include <linux/linkage.h>
15#include <linux/init.h>
16
17#include <asm/assembler.h>
18#include <asm/ptrace.h>
19#include <asm/asm-offsets.h>
20#include <asm/thread_info.h>
21#include <asm/system.h>
22
23
24
25
26
27
28
29
30
31
32
33
34
35 .section ".text.head", "ax"
36ENTRY(stext)
37 setmode PSR_F_BIT | PSR_I_BIT | SVC_MODE, r9 @ ensure svc mode
38 @ and irqs disabled
39#ifndef CONFIG_CPU_CP15
40 ldr r9, =CONFIG_PROCESSOR_ID
41#else
42 mrc p15, 0, r9, c0, c0 @ get processor id
43#endif
44 bl __lookup_processor_type @ r5=procinfo r9=cpuid
45 movs r10, r5 @ invalid processor (r5=0)?
46 beq __error_p @ yes, error 'p'
47 bl __lookup_machine_type @ r5=machinfo
48 movs r8, r5 @ invalid machine (r5=0)?
49 beq __error_a @ yes, error 'a'
50
51 ldr r13, __switch_data @ address to jump to after
52 @ the initialization is done
53 adr lr, BSYM(__after_proc_init) @ return (PIC) address
54 ARM( add pc, r10,
55 THUMB( add r12, r10,
56 THUMB( mov pc, r12 )
57ENDPROC(stext)
58
59
60
61
62__after_proc_init:
63#ifdef CONFIG_CPU_CP15
64
65
66
67
68#ifdef CONFIG_ALIGNMENT_TRAP
69 orr r0, r0,
70#else
71 bic r0, r0,
72#endif
73#ifdef CONFIG_CPU_DCACHE_DISABLE
74 bic r0, r0,
75#endif
76#ifdef CONFIG_CPU_BPREDICT_DISABLE
77 bic r0, r0,
78#endif
79#ifdef CONFIG_CPU_ICACHE_DISABLE
80 bic r0, r0,
81#endif
82#ifdef CONFIG_CPU_HIGH_VECTOR
83 orr r0, r0,
84#else
85 bic r0, r0,
86#endif
87 mcr p15, 0, r0, c1, c0, 0 @ write control reg
88#endif
89
90 mov r3, r13
91 mov pc, r3 @ clear the BSS and jump
92 @ to start_kernel
93ENDPROC(__after_proc_init)
94 .ltorg
95
96#include "head-common.S"
97