Thumb-2: Implementation of the unified start-up and exceptions code
[linux-2.6.git] / arch / arm / kernel / head-nommu.S
1 /*
2  *  linux/arch/arm/kernel/head-nommu.S
3  *
4  *  Copyright (C) 1994-2002 Russell King
5  *  Copyright (C) 2003-2006 Hyok S. Choi
6  *
7  * This program is free software; you can redistribute it and/or modify
8  * it under the terms of the GNU General Public License version 2 as
9  * published by the Free Software Foundation.
10  *
11  *  Common kernel startup code (non-paged MM)
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  * Kernel startup entry point.
25  * ---------------------------
26  *
27  * This is normally called from the decompressor code.  The requirements
28  * are: MMU = off, D-cache = off, I-cache = dont care, r0 = 0,
29  * r1 = machine nr.
30  *
31  * See linux/arch/arm/tools/mach-types for the complete list of machine
32  * numbers for r1.
33  *
34  */
35         .section ".text.head", "ax"
36 ENTRY(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, #PROCINFO_INITFUNC     )
55  THUMB( add     r12, r10, #PROCINFO_INITFUNC    )
56  THUMB( mov     pc, r12                         )
57 ENDPROC(stext)
58
59 /*
60  * Set the Control Register and Read the process ID.
61  */
62 __after_proc_init:
63 #ifdef CONFIG_CPU_CP15
64         mrc     p15, 0, r0, c1, c0, 0           @ read control reg
65 #ifdef CONFIG_ALIGNMENT_TRAP
66         orr     r0, r0, #CR_A
67 #else
68         bic     r0, r0, #CR_A
69 #endif
70 #ifdef CONFIG_CPU_DCACHE_DISABLE
71         bic     r0, r0, #CR_C
72 #endif
73 #ifdef CONFIG_CPU_BPREDICT_DISABLE
74         bic     r0, r0, #CR_Z
75 #endif
76 #ifdef CONFIG_CPU_ICACHE_DISABLE
77         bic     r0, r0, #CR_I
78 #endif
79 #ifdef CONFIG_CPU_HIGH_VECTOR
80         orr     r0, r0, #CR_V
81 #else
82         bic     r0, r0, #CR_V
83 #endif
84         mcr     p15, 0, r0, c1, c0, 0           @ write control reg
85 #endif /* CONFIG_CPU_CP15 */
86
87         mov     r3, r13
88         mov     pc, r3                          @ clear the BSS and jump
89                                                 @ to start_kernel
90 ENDPROC(__after_proc_init)
91         .ltorg
92
93 #include "head-common.S"