head-nommu.S 2.3 KB
Newer Older
H
Hyok S. Choi 已提交
1 2 3 4 5 6 7 8 9 10 11 12 13 14 15 16 17 18
/*
 *  linux/arch/arm/kernel/head-nommu.S
 *
 *  Copyright (C) 1994-2002 Russell King
 *  Copyright (C) 2003-2006 Hyok S. Choi
 *
 * This program is free software; you can redistribute it and/or modify
 * it under the terms of the GNU General Public License version 2 as
 * published by the Free Software Foundation.
 *
 *  Common kernel startup code (non-paged MM)
 *
 */
#include <linux/linkage.h>
#include <linux/init.h>

#include <asm/assembler.h>
#include <asm/ptrace.h>
19
#include <asm/asm-offsets.h>
20
#include <asm/thread_info.h>
H
Hyok S. Choi 已提交
21 22 23 24 25 26 27 28 29 30 31 32 33 34
#include <asm/system.h>

/*
 * Kernel startup entry point.
 * ---------------------------
 *
 * This is normally called from the decompressor code.  The requirements
 * are: MMU = off, D-cache = off, I-cache = dont care, r0 = 0,
 * r1 = machine nr.
 *
 * See linux/arch/arm/tools/mach-types for the complete list of machine
 * numbers for r1.
 *
 */
35
	.section ".text.head", "ax"
H
Hyok S. Choi 已提交
36
ENTRY(stext)
37
	setmode	PSR_F_BIT | PSR_I_BIT | SVC_MODE, r9 @ ensure svc mode
H
Hyok S. Choi 已提交
38
						@ and irqs disabled
39 40 41
#ifndef CONFIG_CPU_CP15
	ldr	r9, =CONFIG_PROCESSOR_ID
#else
H
Hyok S. Choi 已提交
42
	mrc	p15, 0, r9, c0, c0		@ get processor id
43
#endif
H
Hyok S. Choi 已提交
44 45 46 47 48 49 50 51 52
	bl	__lookup_processor_type		@ r5=procinfo r9=cpuid
	movs	r10, r5				@ invalid processor (r5=0)?
	beq	__error_p				@ yes, error 'p'
	bl	__lookup_machine_type		@ r5=machinfo
	movs	r8, r5				@ invalid machine (r5=0)?
	beq	__error_a			@ yes, error 'a'

	ldr	r13, __switch_data		@ address to jump to after
						@ the initialization is done
53 54 55 56
	adr	lr, BSYM(__after_proc_init)	@ return (PIC) address
 ARM(	add	pc, r10, #PROCINFO_INITFUNC	)
 THUMB(	add	r12, r10, #PROCINFO_INITFUNC	)
 THUMB(	mov	pc, r12				)
57
ENDPROC(stext)
H
Hyok S. Choi 已提交
58 59 60 61 62

/*
 * Set the Control Register and Read the process ID.
 */
__after_proc_init:
63
#ifdef CONFIG_CPU_CP15
64 65 66 67
	/*
	 * CP15 system control register value returned in r0 from
	 * the CPU init function.
	 */
H
Hyok S. Choi 已提交
68 69 70 71 72 73 74 75 76 77 78 79 80
#ifdef CONFIG_ALIGNMENT_TRAP
	orr	r0, r0, #CR_A
#else
	bic	r0, r0, #CR_A
#endif
#ifdef CONFIG_CPU_DCACHE_DISABLE
	bic	r0, r0, #CR_C
#endif
#ifdef CONFIG_CPU_BPREDICT_DISABLE
	bic	r0, r0, #CR_Z
#endif
#ifdef CONFIG_CPU_ICACHE_DISABLE
	bic	r0, r0, #CR_I
81 82 83 84 85
#endif
#ifdef CONFIG_CPU_HIGH_VECTOR
	orr	r0, r0, #CR_V
#else
	bic	r0, r0, #CR_V
H
Hyok S. Choi 已提交
86 87
#endif
	mcr	p15, 0, r0, c1, c0, 0		@ write control reg
88
#endif /* CONFIG_CPU_CP15 */
H
Hyok S. Choi 已提交
89

90 91
	mov	r3, r13
	mov	pc, r3				@ clear the BSS and jump
H
Hyok S. Choi 已提交
92
						@ to start_kernel
93
ENDPROC(__after_proc_init)
94
	.ltorg
H
Hyok S. Choi 已提交
95 96

#include "head-common.S"