[deliverable/linux.git] / arch / arm / kernel / head-nommu.S

/*
 *  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>
#include <asm/asm-offsets.h>
#include <asm/memory.h>
#include <asm/cp15.h>
#include <asm/thread_info.h>
#include <asm/v7m.h>
#include <asm/mpu.h>
#include <asm/page.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.
 *
 */

	__HEAD

#ifdef CONFIG_CPU_THUMBONLY
	.thumb
ENTRY(stext)
#else
	.arm
ENTRY(stext)

 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:			)
#endif

	setmode	PSR_F_BIT | PSR_I_BIT | SVC_MODE, r9 @ ensure svc mode
						@ and irqs disabled
#if defined(CONFIG_CPU_CP15)
	mrc	p15, 0, r9, c0, c0		@ get processor id
#elif defined(CONFIG_CPU_V7M)
	ldr	r9, =BASEADDR_V7M_SCB
	ldr	r9, [r9, V7M_SCB_CPUID]
#else
	ldr	r9, =CONFIG_PROCESSOR_ID
#endif
	bl	__lookup_processor_type		@ r5=procinfo r9=cpuid
	movs	r10, r5				@ invalid processor (r5=0)?
	beq	__error_p				@ yes, error 'p'

#ifdef CONFIG_ARM_MPU
	/* Calculate the size of a region covering just the kernel */
	ldr	r5, =PLAT_PHYS_OFFSET		@ Region start: PHYS_OFFSET
	ldr     r6, =(_end)			@ Cover whole kernel
	sub	r6, r6, r5			@ Minimum size of region to map
	clz	r6, r6				@ Region size must be 2^N...
	rsb	r6, r6, #31			@ ...so round up region size
	lsl	r6, r6, #MPU_RSR_SZ		@ Put size in right field
	orr	r6, r6, #(1 << MPU_RSR_EN)	@ Set region enabled bit
	bl	__setup_mpu
#endif
	ldr	r13, =__mmap_switched		@ address to jump to after
						@ initialising sctlr
	adr	lr, BSYM(1f)			@ return (PIC) address
	ldr	r12, [r10, #PROCINFO_INITFUNC]
	add	r12, r12, r10
	ret	r12
 1:	b	__after_proc_init
ENDPROC(stext)

#ifdef CONFIG_SMP
	.text
ENTRY(secondary_startup)
	/*
	 * Common entry point for secondary CPUs.
	 *
	 * Ensure that we're in SVC mode, and IRQs are disabled.  Lookup
	 * the processor type - there is no need to check the machine type
	 * as it has already been validated by the primary processor.
	 */
	setmode	PSR_F_BIT | PSR_I_BIT | SVC_MODE, r9
#ifndef CONFIG_CPU_CP15
	ldr	r9, =CONFIG_PROCESSOR_ID
#else
	mrc	p15, 0, r9, c0, c0		@ get processor id
#endif
	bl	__lookup_processor_type		@ r5=procinfo r9=cpuid
	movs	r10, r5				@ invalid processor?
	beq	__error_p			@ yes, error 'p'

	adr	r4, __secondary_data
	ldmia	r4, {r7, r12}

#ifdef CONFIG_ARM_MPU
	/* Use MPU region info supplied by __cpu_up */
	ldr	r6, [r7]			@ get secondary_data.mpu_szr
	bl      __setup_mpu			@ Initialize the MPU
#endif

	adr	lr, BSYM(__after_proc_init)	@ return address
	mov	r13, r12			@ __secondary_switched address
	ldr	r12, [r10, #PROCINFO_INITFUNC]
	add	r12, r12, r10
	ret	r12
ENDPROC(secondary_startup)

ENTRY(__secondary_switched)
	ldr	sp, [r7, #8]			@ set up the stack pointer
	mov	fp, #0
	b	secondary_start_kernel
ENDPROC(__secondary_switched)

	.type	__secondary_data, %object
__secondary_data:
	.long	secondary_data
	.long	__secondary_switched
#endif /* CONFIG_SMP */

/*
 * Set the Control Register and Read the process ID.
 */
__after_proc_init:
#ifdef CONFIG_CPU_CP15
	/*
	 * CP15 system control register value returned in r0 from
	 * the CPU init function.
	 */
#if defined(CONFIG_ALIGNMENT_TRAP) && __LINUX_ARM_ARCH__ < 6
	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
#endif
#ifdef CONFIG_CPU_HIGH_VECTOR
	orr	r0, r0, #CR_V
#else
	bic	r0, r0, #CR_V
#endif
	mcr	p15, 0, r0, c1, c0, 0		@ write control reg
#endif /* CONFIG_CPU_CP15 */
	ret	r13
ENDPROC(__after_proc_init)
	.ltorg

#ifdef CONFIG_ARM_MPU


/* Set which MPU region should be programmed */
.macro set_region_nr tmp, rgnr
	mov	\tmp, \rgnr			@ Use static region numbers
	mcr	p15, 0, \tmp, c6, c2, 0		@ Write RGNR
.endm

/* Setup a single MPU region, either D or I side (D-side for unified) */
.macro setup_region bar, acr, sr, side = MPU_DATA_SIDE
	mcr	p15, 0, \bar, c6, c1, (0 + \side)	@ I/DRBAR
	mcr	p15, 0, \acr, c6, c1, (4 + \side)	@ I/DRACR
	mcr	p15, 0, \sr, c6, c1, (2 + \side)		@ I/DRSR
.endm

/*
 * Setup the MPU and initial MPU Regions. We create the following regions:
 * Region 0: Use this for probing the MPU details, so leave disabled.
 * Region 1: Background region - covers the whole of RAM as strongly ordered
 * Region 2: Normal, Shared, cacheable for RAM. From PHYS_OFFSET, size from r6
 * Region 3: Normal, shared, inaccessible from PL0 to protect the vectors page
 *
 * r6: Value to be written to DRSR (and IRSR if required) for MPU_RAM_REGION
*/

ENTRY(__setup_mpu)

	/* Probe for v7 PMSA compliance */
	mrc	p15, 0, r0, c0, c1, 4		@ Read ID_MMFR0
	and	r0, r0, #(MMFR0_PMSA)		@ PMSA field
	teq	r0, #(MMFR0_PMSAv7)		@ PMSA v7
	bne	__error_p			@ Fail: ARM_MPU on NOT v7 PMSA

	/* Determine whether the D/I-side memory map is unified. We set the
	 * flags here and continue to use them for the rest of this function */
	mrc	p15, 0, r0, c0, c0, 4		@ MPUIR
	ands	r5, r0, #MPUIR_DREGION_SZMASK	@ 0 size d region => No MPU
	beq	__error_p			@ Fail: ARM_MPU and no MPU
	tst	r0, #MPUIR_nU			@ MPUIR_nU = 0 for unified

	/* Setup second region first to free up r6 */
	set_region_nr r0, #MPU_RAM_REGION
	isb
	/* Full access from PL0, PL1, shared for CONFIG_SMP, cacheable */
	ldr	r0, =PLAT_PHYS_OFFSET		@ RAM starts at PHYS_OFFSET
	ldr	r5,=(MPU_AP_PL1RW_PL0RW | MPU_RGN_NORMAL)

	setup_region r0, r5, r6, MPU_DATA_SIDE	@ PHYS_OFFSET, shared, enabled
	beq	1f				@ Memory-map not unified
	setup_region r0, r5, r6, MPU_INSTR_SIDE @ PHYS_OFFSET, shared, enabled
1:	isb

	/* First/background region */
	set_region_nr r0, #MPU_BG_REGION
	isb
	/* Execute Never,  strongly ordered, inaccessible to PL0, rw PL1  */
	mov	r0, #0				@ BG region starts at 0x0
	ldr	r5,=(MPU_ACR_XN | MPU_RGN_STRONGLY_ORDERED | MPU_AP_PL1RW_PL0NA)
	mov	r6, #MPU_RSR_ALL_MEM		@ 4GB region, enabled

	setup_region r0, r5, r6, MPU_DATA_SIDE	@ 0x0, BG region, enabled
	beq	2f				@ Memory-map not unified
	setup_region r0, r5, r6, MPU_INSTR_SIDE @ 0x0, BG region, enabled
2:	isb

	/* Vectors region */
	set_region_nr r0, #MPU_VECTORS_REGION
	isb
	/* Shared, inaccessible to PL0, rw PL1 */
	mov	r0, #CONFIG_VECTORS_BASE	@ Cover from VECTORS_BASE
	ldr	r5,=(MPU_AP_PL1RW_PL0NA | MPU_RGN_NORMAL)
	/* Writing N to bits 5:1 (RSR_SZ) --> region size 2^N+1 */
	mov	r6, #(((PAGE_SHIFT - 1) << MPU_RSR_SZ) | 1 << MPU_RSR_EN)

	setup_region r0, r5, r6, MPU_DATA_SIDE	@ VECTORS_BASE, PL0 NA, enabled
	beq	3f				@ Memory-map not unified
	setup_region r0, r5, r6, MPU_INSTR_SIDE	@ VECTORS_BASE, PL0 NA, enabled
3:	isb

	/* Enable the MPU */
	mrc	p15, 0, r0, c1, c0, 0		@ Read SCTLR
	bic     r0, r0, #CR_BR			@ Disable the 'default mem-map'
	orr	r0, r0, #CR_M			@ Set SCTRL.M (MPU on)
	mcr	p15, 0, r0, c1, c0, 0		@ Enable MPU
	isb
	ret	lr
ENDPROC(__setup_mpu)
#endif
#include "head-common.S"
Commit	Line	Data
75d90832 HC	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)
75d90832 HC	12	*
75d90832 HC	13	*/
75d90832 HC	14	#include <linux/linkage.h>
	15	#include <linux/init.h>
	16
	17	#include <asm/assembler.h>
75d90832	18	#include <asm/ptrace.h>
2eb9d315	19	#include <asm/asm-offsets.h>
67c9845b	20	#include <asm/memory.h>
15d07dc9	21	#include <asm/cp15.h>
3b920cef	22	#include <asm/thread_info.h>
55bdd694	23	#include <asm/v7m.h>
67c9845b	24	#include <asm/mpu.h>
9dfc28b6	25	#include <asm/page.h>
75d90832	26
75d90832 HC	27	/*
	28	* Kernel startup entry point.
	29	* ---------------------------
	30	*
	31	* This is normally called from the decompressor code. The requirements
	32	* are: MMU = off, D-cache = off, I-cache = dont care, r0 = 0,
	33	* r1 = machine nr.
	34	*
	35	* See linux/arch/arm/tools/mach-types for the complete list of machine
	36	* numbers for r1.
	37	*
	38	*/
540b5738	39
2abc1c50	40	__HEAD
bc7dea00 UKK	41
	42	#ifdef CONFIG_CPU_THUMBONLY
	43	.thumb
	44	ENTRY(stext)
	45	#else
	46	.arm
75d90832	47	ENTRY(stext)
540b5738 DM	48
	49	THUMB( adr r9, BSYM(1f) ) @ Kernel is always entered in ARM.
	50	THUMB( bx r9 ) @ If this is a Thumb-2 kernel,
	51	THUMB( .thumb ) @ switch to Thumb now.
	52	THUMB(1: )
bc7dea00	53	#endif
540b5738	54
b86040a5	55	setmode PSR_F_BIT \| PSR_I_BIT \| SVC_MODE, r9 @ ensure svc mode
75d90832	56	@ and irqs disabled
55bdd694	57	#if defined(CONFIG_CPU_CP15)
75d90832	58	mrc p15, 0, r9, c0, c0 @ get processor id
55bdd694 CM	59	#elif defined(CONFIG_CPU_V7M)
	60	ldr r9, =BASEADDR_V7M_SCB
	61	ldr r9, [r9, V7M_SCB_CPUID]
	62	#else
	63	ldr r9, =CONFIG_PROCESSOR_ID
f12d0d7c	64	#endif
75d90832 HC	65	bl __lookup_processor_type @ r5=procinfo r9=cpuid
	66	movs r10, r5 @ invalid processor (r5=0)?
	67	beq __error_p @ yes, error 'p'
75d90832	68
67c9845b JA	69	#ifdef CONFIG_ARM_MPU
67c9845b JA	70	/* Calculate the size of a region covering just the kernel */
b713aa0b	71	ldr r5, =PLAT_PHYS_OFFSET @ Region start: PHYS_OFFSET
67c9845b JA	72	ldr r6, =(_end) @ Cover whole kernel
	73	sub r6, r6, r5 @ Minimum size of region to map
	74	clz r6, r6 @ Region size must be 2^N...
	75	rsb r6, r6, #31 @ ...so round up region size
	76	lsl r6, r6, #MPU_RSR_SZ @ Put size in right field
	77	orr r6, r6, #(1 << MPU_RSR_EN) @ Set region enabled bit
	78	bl __setup_mpu
	79	#endif
01fafcab WD	80	ldr r13, =__mmap_switched @ address to jump to after
	81	@ initialising sctlr
	82	adr lr, BSYM(1f) @ return (PIC) address
0a9024e8 RK	83	ldr r12, [r10, #PROCINFO_INITFUNC]
	84	add r12, r12, r10
	85	ret r12
01fafcab	86	1: b __after_proc_init
93ed3970	87	ENDPROC(stext)
75d90832	88
01fafcab	89	#ifdef CONFIG_SMP
2449189b	90	.text
01fafcab WD	91	ENTRY(secondary_startup)
	92	/*
	93	* Common entry point for secondary CPUs.
	94	*
	95	* Ensure that we're in SVC mode, and IRQs are disabled. Lookup
	96	* the processor type - there is no need to check the machine type
	97	* as it has already been validated by the primary processor.
	98	*/
	99	setmode PSR_F_BIT \| PSR_I_BIT \| SVC_MODE, r9
	100	#ifndef CONFIG_CPU_CP15
	101	ldr r9, =CONFIG_PROCESSOR_ID
	102	#else
	103	mrc p15, 0, r9, c0, c0 @ get processor id
	104	#endif
	105	bl __lookup_processor_type @ r5=procinfo r9=cpuid
	106	movs r10, r5 @ invalid processor?
	107	beq __error_p @ yes, error 'p'
	108
	109	adr r4, __secondary_data
	110	ldmia r4, {r7, r12}
eb08375e JA	111
	112	#ifdef CONFIG_ARM_MPU
	113	/* Use MPU region info supplied by __cpu_up */
	114	ldr r6, [r7] @ get secondary_data.mpu_szr
	115	bl __setup_mpu @ Initialize the MPU
	116	#endif
	117
01fafcab WD	118	adr lr, BSYM(__after_proc_init) @ return address
01fafcab WD	119	mov r13, r12 @ __secondary_switched address
0a9024e8 RK	120	ldr r12, [r10, #PROCINFO_INITFUNC]
	121	add r12, r12, r10
	122	ret r12
01fafcab WD	123	ENDPROC(secondary_startup)
	124
	125	ENTRY(__secondary_switched)
	126	ldr sp, [r7, #8] @ set up the stack pointer
	127	mov fp, #0
	128	b secondary_start_kernel
	129	ENDPROC(__secondary_switched)
	130
	131	.type __secondary_data, %object
	132	__secondary_data:
	133	.long secondary_data
	134	.long __secondary_switched
	135	#endif /* CONFIG_SMP */
	136
75d90832 HC	137	/*
	138	* Set the Control Register and Read the process ID.
	139	*/
75d90832	140	__after_proc_init:
f12d0d7c	141	#ifdef CONFIG_CPU_CP15
05efde9d CM	142	/*
	143	* CP15 system control register value returned in r0 from
	144	* the CPU init function.
	145	*/
76e09204	146	#if defined(CONFIG_ALIGNMENT_TRAP) && __LINUX_ARM_ARCH__ < 6
75d90832 HC	147	orr r0, r0, #CR_A
	148	#else
	149	bic r0, r0, #CR_A
	150	#endif
	151	#ifdef CONFIG_CPU_DCACHE_DISABLE
	152	bic r0, r0, #CR_C
	153	#endif
	154	#ifdef CONFIG_CPU_BPREDICT_DISABLE
	155	bic r0, r0, #CR_Z
	156	#endif
	157	#ifdef CONFIG_CPU_ICACHE_DISABLE
	158	bic r0, r0, #CR_I
6afd6fae HC	159	#endif
	160	#ifdef CONFIG_CPU_HIGH_VECTOR
	161	orr r0, r0, #CR_V
	162	#else
	163	bic r0, r0, #CR_V
75d90832 HC	164	#endif
75d90832 HC	165	mcr p15, 0, r0, c1, c0, 0 @ write control reg
f12d0d7c	166	#endif /* CONFIG_CPU_CP15 */
6ebbf2ce	167	ret r13
93ed3970	168	ENDPROC(__after_proc_init)
3b920cef	169	.ltorg
75d90832	170
67c9845b JA	171	#ifdef CONFIG_ARM_MPU
	172
	173
	174	/* Set which MPU region should be programmed */
	175	.macro set_region_nr tmp, rgnr
	176	mov \tmp, \rgnr @ Use static region numbers
	177	mcr p15, 0, \tmp, c6, c2, 0 @ Write RGNR
	178	.endm
	179
	180	/* Setup a single MPU region, either D or I side (D-side for unified) */
	181	.macro setup_region bar, acr, sr, side = MPU_DATA_SIDE
	182	mcr p15, 0, \bar, c6, c1, (0 + \side) @ I/DRBAR
	183	mcr p15, 0, \acr, c6, c1, (4 + \side) @ I/DRACR
	184	mcr p15, 0, \sr, c6, c1, (2 + \side) @ I/DRSR
	185	.endm
	186
	187	/*
	188	* Setup the MPU and initial MPU Regions. We create the following regions:
	189	* Region 0: Use this for probing the MPU details, so leave disabled.
	190	* Region 1: Background region - covers the whole of RAM as strongly ordered
	191	* Region 2: Normal, Shared, cacheable for RAM. From PHYS_OFFSET, size from r6
9dfc28b6	192	* Region 3: Normal, shared, inaccessible from PL0 to protect the vectors page
67c9845b JA	193	*
	194	* r6: Value to be written to DRSR (and IRSR if required) for MPU_RAM_REGION
	195	*/
	196
	197	ENTRY(__setup_mpu)
	198
	199	/* Probe for v7 PMSA compliance */
	200	mrc p15, 0, r0, c0, c1, 4 @ Read ID_MMFR0
	201	and r0, r0, #(MMFR0_PMSA) @ PMSA field
	202	teq r0, #(MMFR0_PMSAv7) @ PMSA v7
	203	bne __error_p @ Fail: ARM_MPU on NOT v7 PMSA
	204
	205	/* Determine whether the D/I-side memory map is unified. We set the
	206	* flags here and continue to use them for the rest of this function */
	207	mrc p15, 0, r0, c0, c0, 4 @ MPUIR
	208	ands r5, r0, #MPUIR_DREGION_SZMASK @ 0 size d region => No MPU
	209	beq __error_p @ Fail: ARM_MPU and no MPU
	210	tst r0, #MPUIR_nU @ MPUIR_nU = 0 for unified
	211
	212	/* Setup second region first to free up r6 */
	213	set_region_nr r0, #MPU_RAM_REGION
	214	isb
	215	/* Full access from PL0, PL1, shared for CONFIG_SMP, cacheable */
b713aa0b	216	ldr r0, =PLAT_PHYS_OFFSET @ RAM starts at PHYS_OFFSET
67c9845b JA	217	ldr r5,=(MPU_AP_PL1RW_PL0RW \| MPU_RGN_NORMAL)
	218
	219	setup_region r0, r5, r6, MPU_DATA_SIDE @ PHYS_OFFSET, shared, enabled
	220	beq 1f @ Memory-map not unified
	221	setup_region r0, r5, r6, MPU_INSTR_SIDE @ PHYS_OFFSET, shared, enabled
	222	1: isb
	223
	224	/* First/background region */
	225	set_region_nr r0, #MPU_BG_REGION
	226	isb
	227	/* Execute Never, strongly ordered, inaccessible to PL0, rw PL1 */
	228	mov r0, #0 @ BG region starts at 0x0
	229	ldr r5,=(MPU_ACR_XN \| MPU_RGN_STRONGLY_ORDERED \| MPU_AP_PL1RW_PL0NA)
	230	mov r6, #MPU_RSR_ALL_MEM @ 4GB region, enabled
	231
	232	setup_region r0, r5, r6, MPU_DATA_SIDE @ 0x0, BG region, enabled
	233	beq 2f @ Memory-map not unified
	234	setup_region r0, r5, r6, MPU_INSTR_SIDE @ 0x0, BG region, enabled
	235	2: isb
	236
9dfc28b6 JA	237	/* Vectors region */
	238	set_region_nr r0, #MPU_VECTORS_REGION
	239	isb
	240	/* Shared, inaccessible to PL0, rw PL1 */
	241	mov r0, #CONFIG_VECTORS_BASE @ Cover from VECTORS_BASE
	242	ldr r5,=(MPU_AP_PL1RW_PL0NA \| MPU_RGN_NORMAL)
	243	/* Writing N to bits 5:1 (RSR_SZ) --> region size 2^N+1 */
	244	mov r6, #(((PAGE_SHIFT - 1) << MPU_RSR_SZ) \| 1 << MPU_RSR_EN)
	245
	246	setup_region r0, r5, r6, MPU_DATA_SIDE @ VECTORS_BASE, PL0 NA, enabled
	247	beq 3f @ Memory-map not unified
	248	setup_region r0, r5, r6, MPU_INSTR_SIDE @ VECTORS_BASE, PL0 NA, enabled
	249	3: isb
	250
67c9845b JA	251	/* Enable the MPU */
	252	mrc p15, 0, r0, c1, c0, 0 @ Read SCTLR
	253	bic r0, r0, #CR_BR @ Disable the 'default mem-map'
	254	orr r0, r0, #CR_M @ Set SCTRL.M (MPU on)
	255	mcr p15, 0, r0, c1, c0, 0 @ Enable MPU
	256	isb
6ebbf2ce	257	ret lr
67c9845b JA	258	ENDPROC(__setup_mpu)
67c9845b JA	259	#endif
75d90832	260	#include "head-common.S"