Module Name:    src
Committed By:   matt
Date:           Fri Apr 11 02:37:45 UTC 2014

Modified Files:
        src/sys/arch/arm/cortex: a9_mpsubr.S

Log Message:
Simplify calls into .text by using KERNEL_BASE_VOFFSET.


To generate a diff of this commit:
cvs rdiff -u -r1.15 -r1.16 src/sys/arch/arm/cortex/a9_mpsubr.S

Please note that diffs are not public domain; they are subject to the
copyright notices on the relevant files.

Modified files:

Index: src/sys/arch/arm/cortex/a9_mpsubr.S
diff -u src/sys/arch/arm/cortex/a9_mpsubr.S:1.15 src/sys/arch/arm/cortex/a9_mpsubr.S:1.16
--- src/sys/arch/arm/cortex/a9_mpsubr.S:1.15	Thu Apr 10 16:07:50 2014
+++ src/sys/arch/arm/cortex/a9_mpsubr.S	Fri Apr 11 02:37:45 2014
@@ -1,4 +1,4 @@
-/*	$NetBSD: a9_mpsubr.S,v 1.15 2014/04/10 16:07:50 skrll Exp $	*/
+/*	$NetBSD: a9_mpsubr.S,v 1.16 2014/04/11 02:37:45 matt Exp $	*/
 /*-
  * Copyright (c) 2012 The NetBSD Foundation, Inc.
  * All rights reserved.
@@ -41,22 +41,18 @@
 
 // We'll modify va and pa at run time so we can use relocatable addresses.
 #define MMU_INIT(va,pa,n_sec,attr) \
-	.word	(va)|(n_sec)				    ; \
-	.word	(pa)|(attr)				    ; \
+	.word	((va) & 0xffffffff)|(n_sec)		    ; \
+	.word	((pa) & 0xffffffff)|(attr)		    ; \
 
 // Set up a preliminary mapping in the MMU to allow us to run at KERNEL_BASE
 // with caches on.  If we are MULTIPROCESSOR, save the TTB address.
 //
 arm_boot_l1pt_init:
 #if defined(MULTIPROCESSOR)
-#if defined(KERNEL_BASES_EQUAL)
 	movw	r3, #:lower16:cortex_mmuinfo
 	movt	r3, #:upper16:cortex_mmuinfo
-#else
-	adr	r3, arm_boot_l1pt_init
-	movw	r2, #:lower16:cortex_mmuinfo
-	movt	r2, #:upper16:cortex_mmuinfo
-	bfi	r3, r2, #0, #28
+#if !defined(KERNEL_BASES_EQUAL)
+	sub	r3, r3, #KERNEL_BASE_VOFFSET
 #endif
 	str	r0, [r3]
 
@@ -337,6 +333,7 @@ cortex_init:
         mov	r0, #0
         msr	spsr_sxc, r0			// set SPSR[23:8] to known value
 
+	XPUTC(#64)
 #if defined(CPU_CORTEXA7) || defined(CPU_CORTEXA15)
 	//
 	// If SMP is already enabled, don't do anything.
@@ -360,16 +357,8 @@ cortex_init:
 	isb
 #endif
 
-	XPUTC(#64)
-#if defined(KERNEL_BASES_EQUAL)
-	bl	_C_LABEL(armv7_icache_inv_all)
-#else
-	adr	ip, cortex_init
-	movw	r0, #:lower16:_C_LABEL(armv7_icache_inv_all)
-	movt	r0, #:upper16:_C_LABEL(armv7_icache_inv_all)
-	bfi	ip, r0, #0, #28
-	blx	ip				// toss i-cache
-#endif
+	mov	r0, #0
+	mcr	p15, 0, r0, c7, c5, 0		// toss i-cache
 
 #if defined(CPU_CORTEXA5) || defined(CPU_CORTEXA9)
 	//
@@ -400,10 +389,9 @@ cortex_init:
 #if defined(KERNEL_BASES_EQUAL)
 	bl	_C_LABEL(armv7_dcache_wbinv_all)
 #else
-	adr	ip, cortex_init
-	movw	r0, #:lower16:_C_LABEL(armv7_dcache_wbinv_all)
-	movt	r0, #:upper16:_C_LABEL(armv7_dcache_wbinv_all)
-	bfi	ip, r0, #0, #28
+	movw	ip, #:lower16:_C_LABEL(armv7_dcache_wbinv_all)
+	movt	ip, #:upper16:_C_LABEL(armv7_dcache_wbinv_all)
+	sub	ip, ip, #KERNEL_BASE_VOFFSET
 	blx	ip				// writeback & toss d-cache
 #endif
 	XPUTC(#67)
@@ -463,7 +451,7 @@ cortex_init:
 	mcr	p15, 0, r0, c1, c0, 1		// ACTLR write
 	isb
 
-#if defined(MULTIPROCESSOR) && (defined(CPU_CORTEXA5) ||  defined(CPU_CORTEXA9))
+#if defined(MULTIPROCESSOR) && (defined(CPU_CORTEXA5) || defined(CPU_CORTEXA7) || defined(CPU_CORTEXA9))
 	//
 	// Step 4b (continued on A5/A9), ACTRL.FW=1)
 	//
@@ -543,14 +531,10 @@ cortex_mpstart:
 	//
 
 	// Get our initial temporary TTB so we can switch to it.
-#if defined(KERNEL_BASES_EQUAL)
 	movw	r7, #:lower16:_C_LABEL(cortex_mmuinfo)
 	movt	r7, #:upper16:_C_LABEL(cortex_mmuinfo)
-#else
-	adr	r7, cortex_mpstart
-	movw	r8, #:lower16:_C_LABEL(cortex_mmuinfo)
-	movt	r8, #:upper16:_C_LABEL(cortex_mmuinfo)
-	bfi	r7, r8, #0, #28
+#if !defined(KERNEL_BASES_EQUAL)
+	sub	r7, r7, #KERNEL_BASE_VOFFSET
 #endif
 	dmb
 	ldr	r0, [r7]			// load saved TTB address

Reply via email to