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/cp15.h>
21
#include <asm/thread_info.h>
H
Hyok S. Choi 已提交
22 23 24 25 26 27 28 29 30 31 32 33 34

/*
 * 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 36
	.arm

37
	__HEAD
H
Hyok S. Choi 已提交
38
ENTRY(stext)
39 40 41 42 43 44

 THUMB(	adr	r9, BSYM(1f)	)	@ Kernel is always entered in ARM.
 THUMB(	bx	r9		)	@ If this is a Thumb-2 kernel,
 THUMB(	.thumb			)	@ switch to Thumb now.
 THUMB(1:			)

45
	setmode	PSR_F_BIT | PSR_I_BIT | SVC_MODE, r9 @ ensure svc mode
H
Hyok S. Choi 已提交
46
						@ and irqs disabled
47 48 49
#ifndef CONFIG_CPU_CP15
	ldr	r9, =CONFIG_PROCESSOR_ID
#else
H
Hyok S. Choi 已提交
50
	mrc	p15, 0, r9, c0, c0		@ get processor id
51
#endif
H
Hyok S. Choi 已提交
52 53 54 55
	bl	__lookup_processor_type		@ r5=procinfo r9=cpuid
	movs	r10, r5				@ invalid processor (r5=0)?
	beq	__error_p				@ yes, error 'p'

56 57 58 59
	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				)
60
ENDPROC(stext)
H
Hyok S. Choi 已提交
61 62 63 64 65

/*
 * Set the Control Register and Read the process ID.
 */
__after_proc_init:
66
#ifdef CONFIG_CPU_CP15
67 68 69 70
	/*
	 * CP15 system control register value returned in r0 from
	 * the CPU init function.
	 */
71
#if defined(CONFIG_ALIGNMENT_TRAP) && __LINUX_ARM_ARCH__ < 6
H
Hyok S. Choi 已提交
72 73 74 75 76 77 78 79 80 81 82 83
	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
84 85 86 87 88
#endif
#ifdef CONFIG_CPU_HIGH_VECTOR
	orr	r0, r0, #CR_V
#else
	bic	r0, r0, #CR_V
H
Hyok S. Choi 已提交
89 90
#endif
	mcr	p15, 0, r0, c1, c0, 0		@ write control reg
91
#endif /* CONFIG_CPU_CP15 */
H
Hyok S. Choi 已提交
92

93
	b	__mmap_switched			@ clear the BSS and jump
H
Hyok S. Choi 已提交
94
						@ to start_kernel
95
ENDPROC(__after_proc_init)
96
	.ltorg
H
Hyok S. Choi 已提交
97 98

#include "head-common.S"