diff options
| -rw-r--r-- | arch/arm/Makefile | 2 | ||||
| -rw-r--r-- | arch/arm/kernel/head-common.S | 217 | ||||
| -rw-r--r-- | arch/arm/kernel/head-nommu.S | 83 | ||||
| -rw-r--r-- | arch/arm/kernel/head.S | 207 |
4 files changed, 302 insertions, 207 deletions
diff --git a/arch/arm/Makefile b/arch/arm/Makefile index fbfc14a56b96..e3770ed87825 100644 --- a/arch/arm/Makefile +++ b/arch/arm/Makefile | |||
| @@ -69,7 +69,7 @@ AFLAGS +=$(CFLAGS_ABI) $(arch-y) $(tune-y) -msoft-float | |||
| 69 | CHECKFLAGS += -D__arm__ | 69 | CHECKFLAGS += -D__arm__ |
| 70 | 70 | ||
| 71 | #Default value | 71 | #Default value |
| 72 | head-y := arch/arm/kernel/head.o arch/arm/kernel/init_task.o | 72 | head-y := arch/arm/kernel/head$(MMUEXT).o arch/arm/kernel/init_task.o |
| 73 | textofs-y := 0x00008000 | 73 | textofs-y := 0x00008000 |
| 74 | 74 | ||
| 75 | machine-$(CONFIG_ARCH_RPC) := rpc | 75 | machine-$(CONFIG_ARCH_RPC) := rpc |
diff --git a/arch/arm/kernel/head-common.S b/arch/arm/kernel/head-common.S new file mode 100644 index 000000000000..a52da0ddb43d --- /dev/null +++ b/arch/arm/kernel/head-common.S | |||
| @@ -0,0 +1,217 @@ | |||
| 1 | /* | ||
| 2 | * linux/arch/arm/kernel/head-common.S | ||
| 3 | * | ||
| 4 | * Copyright (C) 1994-2002 Russell King | ||
| 5 | * Copyright (c) 2003 ARM Limited | ||
| 6 | * All Rights Reserved | ||
| 7 | * | ||
| 8 | * This program is free software; you can redistribute it and/or modify | ||
| 9 | * it under the terms of the GNU General Public License version 2 as | ||
| 10 | * published by the Free Software Foundation. | ||
| 11 | * | ||
| 12 | */ | ||
| 13 | |||
| 14 | .type __switch_data, %object | ||
| 15 | __switch_data: | ||
| 16 | .long __mmap_switched | ||
| 17 | .long __data_loc @ r4 | ||
| 18 | .long __data_start @ r5 | ||
| 19 | .long __bss_start @ r6 | ||
| 20 | .long _end @ r7 | ||
| 21 | .long processor_id @ r4 | ||
| 22 | .long __machine_arch_type @ r5 | ||
| 23 | .long cr_alignment @ r6 | ||
| 24 | .long init_thread_union + THREAD_START_SP @ sp | ||
| 25 | |||
| 26 | /* | ||
| 27 | * The following fragment of code is executed with the MMU on in MMU mode, | ||
| 28 | * and uses absolute addresses; this is not position independent. | ||
| 29 | * | ||
| 30 | * r0 = cp#15 control register | ||
| 31 | * r1 = machine ID | ||
| 32 | * r9 = processor ID | ||
| 33 | */ | ||
| 34 | .type __mmap_switched, %function | ||
| 35 | __mmap_switched: | ||
| 36 | adr r3, __switch_data + 4 | ||
| 37 | |||
| 38 | ldmia r3!, {r4, r5, r6, r7} | ||
| 39 | cmp r4, r5 @ Copy data segment if needed | ||
| 40 | 1: cmpne r5, r6 | ||
| 41 | ldrne fp, [r4], #4 | ||
| 42 | strne fp, [r5], #4 | ||
| 43 | bne 1b | ||
| 44 | |||
| 45 | mov fp, #0 @ Clear BSS (and zero fp) | ||
| 46 | 1: cmp r6, r7 | ||
| 47 | strcc fp, [r6],#4 | ||
| 48 | bcc 1b | ||
| 49 | |||
| 50 | ldmia r3, {r4, r5, r6, sp} | ||
| 51 | str r9, [r4] @ Save processor ID | ||
| 52 | str r1, [r5] @ Save machine type | ||
| 53 | bic r4, r0, #CR_A @ Clear 'A' bit | ||
| 54 | stmia r6, {r0, r4} @ Save control register values | ||
| 55 | b start_kernel | ||
| 56 | |||
| 57 | /* | ||
| 58 | * Exception handling. Something went wrong and we can't proceed. We | ||
| 59 | * ought to tell the user, but since we don't have any guarantee that | ||
| 60 | * we're even running on the right architecture, we do virtually nothing. | ||
| 61 | * | ||
| 62 | * If CONFIG_DEBUG_LL is set we try to print out something about the error | ||
| 63 | * and hope for the best (useful if bootloader fails to pass a proper | ||
| 64 | * machine ID for example). | ||
| 65 | */ | ||
| 66 | |||
| 67 | .type __error_p, %function | ||
| 68 | __error_p: | ||
| 69 | #ifdef CONFIG_DEBUG_LL | ||
| 70 | adr r0, str_p1 | ||
| 71 | bl printascii | ||
| 72 | b __error | ||
| 73 | str_p1: .asciz "\nError: unrecognized/unsupported processor variant.\n" | ||
| 74 | .align | ||
| 75 | #endif | ||
| 76 | |||
| 77 | .type __error_a, %function | ||
| 78 | __error_a: | ||
| 79 | #ifdef CONFIG_DEBUG_LL | ||
| 80 | mov r4, r1 @ preserve machine ID | ||
| 81 | adr r0, str_a1 | ||
| 82 | bl printascii | ||
| 83 | mov r0, r4 | ||
| 84 | bl printhex8 | ||
| 85 | adr r0, str_a2 | ||
| 86 | bl printascii | ||
| 87 | adr r3, 3f | ||
| 88 | ldmia r3, {r4, r5, r6} @ get machine desc list | ||
| 89 | sub r4, r3, r4 @ get offset between virt&phys | ||
| 90 | add r5, r5, r4 @ convert virt addresses to | ||
| 91 | add r6, r6, r4 @ physical address space | ||
| 92 | 1: ldr r0, [r5, #MACHINFO_TYPE] @ get machine type | ||
| 93 | bl printhex8 | ||
| 94 | mov r0, #'\t' | ||
| 95 | bl printch | ||
| 96 | ldr r0, [r5, #MACHINFO_NAME] @ get machine name | ||
| 97 | add r0, r0, r4 | ||
| 98 | bl printascii | ||
| 99 | mov r0, #'\n' | ||
| 100 | bl printch | ||
| 101 | add r5, r5, #SIZEOF_MACHINE_DESC @ next machine_desc | ||
| 102 | cmp r5, r6 | ||
| 103 | blo 1b | ||
| 104 | adr r0, str_a3 | ||
| 105 | bl printascii | ||
| 106 | b __error | ||
| 107 | str_a1: .asciz "\nError: unrecognized/unsupported machine ID (r1 = 0x" | ||
| 108 | str_a2: .asciz ").\n\nAvailable machine support:\n\nID (hex)\tNAME\n" | ||
| 109 | str_a3: .asciz "\nPlease check your kernel config and/or bootloader.\n" | ||
| 110 | .align | ||
| 111 | #endif | ||
| 112 | |||
| 113 | .type __error, %function | ||
| 114 | __error: | ||
| 115 | #ifdef CONFIG_ARCH_RPC | ||
| 116 | /* | ||
| 117 | * Turn the screen red on a error - RiscPC only. | ||
| 118 | */ | ||
| 119 | mov r0, #0x02000000 | ||
| 120 | mov r3, #0x11 | ||
| 121 | orr r3, r3, r3, lsl #8 | ||
| 122 | orr r3, r3, r3, lsl #16 | ||
| 123 | str r3, [r0], #4 | ||
| 124 | str r3, [r0], #4 | ||
| 125 | str r3, [r0], #4 | ||
| 126 | str r3, [r0], #4 | ||
| 127 | #endif | ||
| 128 | 1: mov r0, r0 | ||
| 129 | b 1b | ||
| 130 | |||
| 131 | |||
| 132 | /* | ||
| 133 | * Read processor ID register (CP#15, CR0), and look up in the linker-built | ||
| 134 | * supported processor list. Note that we can't use the absolute addresses | ||
| 135 | * for the __proc_info lists since we aren't running with the MMU on | ||
| 136 | * (and therefore, we are not in the correct address space). We have to | ||
| 137 | * calculate the offset. | ||
| 138 | * | ||
| 139 | * r9 = cpuid | ||
| 140 | * Returns: | ||
| 141 | * r3, r4, r6 corrupted | ||
| 142 | * r5 = proc_info pointer in physical address space | ||
| 143 | * r9 = cpuid (preserved) | ||
| 144 | */ | ||
| 145 | .type __lookup_processor_type, %function | ||
| 146 | __lookup_processor_type: | ||
| 147 | adr r3, 3f | ||
| 148 | ldmda r3, {r5 - r7} | ||
| 149 | sub r3, r3, r7 @ get offset between virt&phys | ||
| 150 | add r5, r5, r3 @ convert virt addresses to | ||
| 151 | add r6, r6, r3 @ physical address space | ||
| 152 | 1: ldmia r5, {r3, r4} @ value, mask | ||
| 153 | and r4, r4, r9 @ mask wanted bits | ||
| 154 | teq r3, r4 | ||
| 155 | beq 2f | ||
| 156 | add r5, r5, #PROC_INFO_SZ @ sizeof(proc_info_list) | ||
| 157 | cmp r5, r6 | ||
| 158 | blo 1b | ||
| 159 | mov r5, #0 @ unknown processor | ||
| 160 | 2: mov pc, lr | ||
| 161 | |||
| 162 | /* | ||
| 163 | * This provides a C-API version of the above function. | ||
| 164 | */ | ||
| 165 | ENTRY(lookup_processor_type) | ||
| 166 | stmfd sp!, {r4 - r7, r9, lr} | ||
| 167 | mov r9, r0 | ||
| 168 | bl __lookup_processor_type | ||
| 169 | mov r0, r5 | ||
| 170 | ldmfd sp!, {r4 - r7, r9, pc} | ||
| 171 | |||
| 172 | /* | ||
| 173 | * Look in include/asm-arm/procinfo.h and arch/arm/kernel/arch.[ch] for | ||
| 174 | * more information about the __proc_info and __arch_info structures. | ||
| 175 | */ | ||
| 176 | .long __proc_info_begin | ||
| 177 | .long __proc_info_end | ||
| 178 | 3: .long . | ||
| 179 | .long __arch_info_begin | ||
| 180 | .long __arch_info_end | ||
| 181 | |||
| 182 | /* | ||
| 183 | * Lookup machine architecture in the linker-build list of architectures. | ||
| 184 | * Note that we can't use the absolute addresses for the __arch_info | ||
| 185 | * lists since we aren't running with the MMU on (and therefore, we are | ||
| 186 | * not in the correct address space). We have to calculate the offset. | ||
| 187 | * | ||
| 188 | * r1 = machine architecture number | ||
| 189 | * Returns: | ||
| 190 | * r3, r4, r6 corrupted | ||
| 191 | * r5 = mach_info pointer in physical address space | ||
| 192 | */ | ||
| 193 | .type __lookup_machine_type, %function | ||
| 194 | __lookup_machine_type: | ||
| 195 | adr r3, 3b | ||
| 196 | ldmia r3, {r4, r5, r6} | ||
| 197 | sub r3, r3, r4 @ get offset between virt&phys | ||
| 198 | add r5, r5, r3 @ convert virt addresses to | ||
| 199 | add r6, r6, r3 @ physical address space | ||
| 200 | 1: ldr r3, [r5, #MACHINFO_TYPE] @ get machine type | ||
| 201 | teq r3, r1 @ matches loader number? | ||
| 202 | beq 2f @ found | ||
| 203 | add r5, r5, #SIZEOF_MACHINE_DESC @ next machine_desc | ||
| 204 | cmp r5, r6 | ||
| 205 | blo 1b | ||
| 206 | mov r5, #0 @ unknown machine | ||
| 207 | 2: mov pc, lr | ||
| 208 | |||
| 209 | /* | ||
| 210 | * This provides a C-API version of the above function. | ||
| 211 | */ | ||
| 212 | ENTRY(lookup_machine_type) | ||
| 213 | stmfd sp!, {r4 - r6, lr} | ||
| 214 | mov r1, r0 | ||
| 215 | bl __lookup_machine_type | ||
| 216 | mov r0, r5 | ||
| 217 | ldmfd sp!, {r4 - r6, pc} | ||
diff --git a/arch/arm/kernel/head-nommu.S b/arch/arm/kernel/head-nommu.S new file mode 100644 index 000000000000..b093ab8738b5 --- /dev/null +++ b/arch/arm/kernel/head-nommu.S | |||
| @@ -0,0 +1,83 @@ | |||
| 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 | * for 32-bit CPUs which has a process ID register(CP15). | ||
| 13 | * | ||
| 14 | */ | ||
| 15 | #include <linux/config.h> | ||
| 16 | #include <linux/linkage.h> | ||
| 17 | #include <linux/init.h> | ||
| 18 | |||
| 19 | #include <asm/assembler.h> | ||
| 20 | #include <asm/mach-types.h> | ||
| 21 | #include <asm/procinfo.h> | ||
| 22 | #include <asm/ptrace.h> | ||
| 23 | #include <asm/constants.h> | ||
| 24 | #include <asm/system.h> | ||
| 25 | |||
| 26 | #define PROCINFO_INITFUNC 12 | ||
| 27 | |||
| 28 | /* | ||
| 29 | * Kernel startup entry point. | ||
| 30 | * --------------------------- | ||
| 31 | * | ||
| 32 | * This is normally called from the decompressor code. The requirements | ||
| 33 | * are: MMU = off, D-cache = off, I-cache = dont care, r0 = 0, | ||
| 34 | * r1 = machine nr. | ||
| 35 | * | ||
| 36 | * See linux/arch/arm/tools/mach-types for the complete list of machine | ||
| 37 | * numbers for r1. | ||
| 38 | * | ||
| 39 | */ | ||
| 40 | __INIT | ||
| 41 | .type stext, %function | ||
| 42 | ENTRY(stext) | ||
| 43 | msr cpsr_c, #PSR_F_BIT | PSR_I_BIT | MODE_SVC @ ensure svc mode | ||
| 44 | @ and irqs disabled | ||
| 45 | mrc p15, 0, r9, c0, c0 @ get processor id | ||
| 46 | bl __lookup_processor_type @ r5=procinfo r9=cpuid | ||
| 47 | movs r10, r5 @ invalid processor (r5=0)? | ||
| 48 | beq __error_p @ yes, error 'p' | ||
| 49 | bl __lookup_machine_type @ r5=machinfo | ||
| 50 | movs r8, r5 @ invalid machine (r5=0)? | ||
| 51 | beq __error_a @ yes, error 'a' | ||
| 52 | |||
| 53 | ldr r13, __switch_data @ address to jump to after | ||
| 54 | @ the initialization is done | ||
| 55 | adr lr, __after_proc_init @ return (PIC) address | ||
| 56 | add pc, r10, #PROCINFO_INITFUNC | ||
| 57 | |||
| 58 | /* | ||
| 59 | * Set the Control Register and Read the process ID. | ||
| 60 | */ | ||
| 61 | .type __after_proc_init, %function | ||
| 62 | __after_proc_init: | ||
| 63 | mrc p15, 0, r0, c1, c0, 0 @ read control reg | ||
| 64 | #ifdef CONFIG_ALIGNMENT_TRAP | ||
| 65 | orr r0, r0, #CR_A | ||
| 66 | #else | ||
| 67 | bic r0, r0, #CR_A | ||
| 68 | #endif | ||
| 69 | #ifdef CONFIG_CPU_DCACHE_DISABLE | ||
| 70 | bic r0, r0, #CR_C | ||
| 71 | #endif | ||
| 72 | #ifdef CONFIG_CPU_BPREDICT_DISABLE | ||
| 73 | bic r0, r0, #CR_Z | ||
| 74 | #endif | ||
| 75 | #ifdef CONFIG_CPU_ICACHE_DISABLE | ||
| 76 | bic r0, r0, #CR_I | ||
| 77 | #endif | ||
| 78 | mcr p15, 0, r0, c1, c0, 0 @ write control reg | ||
| 79 | |||
| 80 | mov pc, r13 @ clear the BSS and jump | ||
| 81 | @ to start_kernel | ||
| 82 | |||
| 83 | #include "head-common.S" | ||
diff --git a/arch/arm/kernel/head.S b/arch/arm/kernel/head.S index 571d6d584919..d848f3a38924 100644 --- a/arch/arm/kernel/head.S +++ b/arch/arm/kernel/head.S | |||
| @@ -103,49 +103,6 @@ ENTRY(stext) | |||
| 103 | adr lr, __enable_mmu @ return (PIC) address | 103 | adr lr, __enable_mmu @ return (PIC) address |
| 104 | add pc, r10, #PROCINFO_INITFUNC | 104 | add pc, r10, #PROCINFO_INITFUNC |
| 105 | 105 | ||
| 106 | .type __switch_data, %object | ||
| 107 | __switch_data: | ||
| 108 | .long __mmap_switched | ||
| 109 | .long __data_loc @ r4 | ||
| 110 | .long __data_start @ r5 | ||
| 111 | .long __bss_start @ r6 | ||
| 112 | .long _end @ r7 | ||
| 113 | .long processor_id @ r4 | ||
| 114 | .long __machine_arch_type @ r5 | ||
| 115 | .long cr_alignment @ r6 | ||
| 116 | .long init_thread_union + THREAD_START_SP @ sp | ||
| 117 | |||
| 118 | /* | ||
| 119 | * The following fragment of code is executed with the MMU on, and uses | ||
| 120 | * absolute addresses; this is not position independent. | ||
| 121 | * | ||
| 122 | * r0 = cp#15 control register | ||
| 123 | * r1 = machine ID | ||
| 124 | * r9 = processor ID | ||
| 125 | */ | ||
| 126 | .type __mmap_switched, %function | ||
| 127 | __mmap_switched: | ||
| 128 | adr r3, __switch_data + 4 | ||
| 129 | |||
| 130 | ldmia r3!, {r4, r5, r6, r7} | ||
| 131 | cmp r4, r5 @ Copy data segment if needed | ||
| 132 | 1: cmpne r5, r6 | ||
| 133 | ldrne fp, [r4], #4 | ||
| 134 | strne fp, [r5], #4 | ||
| 135 | bne 1b | ||
| 136 | |||
| 137 | mov fp, #0 @ Clear BSS (and zero fp) | ||
| 138 | 1: cmp r6, r7 | ||
| 139 | strcc fp, [r6],#4 | ||
| 140 | bcc 1b | ||
| 141 | |||
| 142 | ldmia r3, {r4, r5, r6, sp} | ||
| 143 | str r9, [r4] @ Save processor ID | ||
| 144 | str r1, [r5] @ Save machine type | ||
| 145 | bic r4, r0, #CR_A @ Clear 'A' bit | ||
| 146 | stmia r6, {r0, r4} @ Save control register values | ||
| 147 | b start_kernel | ||
| 148 | |||
| 149 | #if defined(CONFIG_SMP) | 106 | #if defined(CONFIG_SMP) |
| 150 | .type secondary_startup, #function | 107 | .type secondary_startup, #function |
| 151 | ENTRY(secondary_startup) | 108 | ENTRY(secondary_startup) |
| @@ -368,166 +325,4 @@ __create_page_tables: | |||
| 368 | mov pc, lr | 325 | mov pc, lr |
| 369 | .ltorg | 326 | .ltorg |
| 370 | 327 | ||
| 371 | 328 | #include "head-common.S" | |
| 372 | |||
| 373 | /* | ||
| 374 | * Exception handling. Something went wrong and we can't proceed. We | ||
| 375 | * ought to tell the user, but since we don't have any guarantee that | ||
| 376 | * we're even running on the right architecture, we do virtually nothing. | ||
| 377 | * | ||
| 378 | * If CONFIG_DEBUG_LL is set we try to print out something about the error | ||
| 379 | * and hope for the best (useful if bootloader fails to pass a proper | ||
| 380 | * machine ID for example). | ||
| 381 | */ | ||
| 382 | |||
| 383 | .type __error_p, %function | ||
| 384 | __error_p: | ||
| 385 | #ifdef CONFIG_DEBUG_LL | ||
| 386 | adr r0, str_p1 | ||
| 387 | bl printascii | ||
| 388 | b __error | ||
| 389 | str_p1: .asciz "\nError: unrecognized/unsupported processor variant.\n" | ||
| 390 | .align | ||
| 391 | #endif | ||
| 392 | |||
| 393 | .type __error_a, %function | ||
| 394 | __error_a: | ||
| 395 | #ifdef CONFIG_DEBUG_LL | ||
| 396 | mov r4, r1 @ preserve machine ID | ||
| 397 | adr r0, str_a1 | ||
| 398 | bl printascii | ||
| 399 | mov r0, r4 | ||
| 400 | bl printhex8 | ||
| 401 | adr r0, str_a2 | ||
| 402 | bl printascii | ||
| 403 | adr r3, 3f | ||
| 404 | ldmia r3, {r4, r5, r6} @ get machine desc list | ||
| 405 | sub r4, r3, r4 @ get offset between virt&phys | ||
| 406 | add r5, r5, r4 @ convert virt addresses to | ||
| 407 | add r6, r6, r4 @ physical address space | ||
| 408 | 1: ldr r0, [r5, #MACHINFO_TYPE] @ get machine type | ||
| 409 | bl printhex8 | ||
| 410 | mov r0, #'\t' | ||
| 411 | bl printch | ||
| 412 | ldr r0, [r5, #MACHINFO_NAME] @ get machine name | ||
| 413 | add r0, r0, r4 | ||
| 414 | bl printascii | ||
| 415 | mov r0, #'\n' | ||
| 416 | bl printch | ||
| 417 | add r5, r5, #SIZEOF_MACHINE_DESC @ next machine_desc | ||
| 418 | cmp r5, r6 | ||
| 419 | blo 1b | ||
| 420 | adr r0, str_a3 | ||
| 421 | bl printascii | ||
| 422 | b __error | ||
| 423 | str_a1: .asciz "\nError: unrecognized/unsupported machine ID (r1 = 0x" | ||
| 424 | str_a2: .asciz ").\n\nAvailable machine support:\n\nID (hex)\tNAME\n" | ||
| 425 | str_a3: .asciz "\nPlease check your kernel config and/or bootloader.\n" | ||
| 426 | .align | ||
| 427 | #endif | ||
| 428 | |||
| 429 | .type __error, %function | ||
| 430 | __error: | ||
| 431 | #ifdef CONFIG_ARCH_RPC | ||
| 432 | /* | ||
| 433 | * Turn the screen red on a error - RiscPC only. | ||
| 434 | */ | ||
| 435 | mov r0, #0x02000000 | ||
| 436 | mov r3, #0x11 | ||
| 437 | orr r3, r3, r3, lsl #8 | ||
| 438 | orr r3, r3, r3, lsl #16 | ||
| 439 | str r3, [r0], #4 | ||
| 440 | str r3, [r0], #4 | ||
| 441 | str r3, [r0], #4 | ||
| 442 | str r3, [r0], #4 | ||
| 443 | #endif | ||
| 444 | 1: mov r0, r0 | ||
| 445 | b 1b | ||
| 446 | |||
| 447 | |||
| 448 | /* | ||
| 449 | * Read processor ID register (CP#15, CR0), and look up in the linker-built | ||
| 450 | * supported processor list. Note that we can't use the absolute addresses | ||
| 451 | * for the __proc_info lists since we aren't running with the MMU on | ||
| 452 | * (and therefore, we are not in the correct address space). We have to | ||
| 453 | * calculate the offset. | ||
| 454 | * | ||
| 455 | * r9 = cpuid | ||
| 456 | * Returns: | ||
| 457 | * r3, r4, r6 corrupted | ||
| 458 | * r5 = proc_info pointer in physical address space | ||
| 459 | * r9 = cpuid (preserved) | ||
| 460 | */ | ||
| 461 | .type __lookup_processor_type, %function | ||
| 462 | __lookup_processor_type: | ||
| 463 | adr r3, 3f | ||
| 464 | ldmda r3, {r5 - r7} | ||
| 465 | sub r3, r3, r7 @ get offset between virt&phys | ||
| 466 | add r5, r5, r3 @ convert virt addresses to | ||
| 467 | add r6, r6, r3 @ physical address space | ||
| 468 | 1: ldmia r5, {r3, r4} @ value, mask | ||
| 469 | and r4, r4, r9 @ mask wanted bits | ||
| 470 | teq r3, r4 | ||
| 471 | beq 2f | ||
| 472 | add r5, r5, #PROC_INFO_SZ @ sizeof(proc_info_list) | ||
| 473 | cmp r5, r6 | ||
| 474 | blo 1b | ||
| 475 | mov r5, #0 @ unknown processor | ||
| 476 | 2: mov pc, lr | ||
| 477 | |||
| 478 | /* | ||
| 479 | * This provides a C-API version of the above function. | ||
| 480 | */ | ||
| 481 | ENTRY(lookup_processor_type) | ||
| 482 | stmfd sp!, {r4 - r7, r9, lr} | ||
| 483 | mov r9, r0 | ||
| 484 | bl __lookup_processor_type | ||
| 485 | mov r0, r5 | ||
| 486 | ldmfd sp!, {r4 - r7, r9, pc} | ||
| 487 | |||
| 488 | /* | ||
| 489 | * Look in include/asm-arm/procinfo.h and arch/arm/kernel/arch.[ch] for | ||
| 490 | * more information about the __proc_info and __arch_info structures. | ||
| 491 | */ | ||
| 492 | .long __proc_info_begin | ||
| 493 | .long __proc_info_end | ||
| 494 | 3: .long . | ||
| 495 | .long __arch_info_begin | ||
| 496 | .long __arch_info_end | ||
| 497 | |||
| 498 | /* | ||
| 499 | * Lookup machine architecture in the linker-build list of architectures. | ||
| 500 | * Note that we can't use the absolute addresses for the __arch_info | ||
| 501 | * lists since we aren't running with the MMU on (and therefore, we are | ||
| 502 | * not in the correct address space). We have to calculate the offset. | ||
| 503 | * | ||
| 504 | * r1 = machine architecture number | ||
| 505 | * Returns: | ||
| 506 | * r3, r4, r6 corrupted | ||
| 507 | * r5 = mach_info pointer in physical address space | ||
| 508 | */ | ||
| 509 | .type __lookup_machine_type, %function | ||
| 510 | __lookup_machine_type: | ||
| 511 | adr r3, 3b | ||
| 512 | ldmia r3, {r4, r5, r6} | ||
| 513 | sub r3, r3, r4 @ get offset between virt&phys | ||
| 514 | add r5, r5, r3 @ convert virt addresses to | ||
| 515 | add r6, r6, r3 @ physical address space | ||
| 516 | 1: ldr r3, [r5, #MACHINFO_TYPE] @ get machine type | ||
| 517 | teq r3, r1 @ matches loader number? | ||
| 518 | beq 2f @ found | ||
| 519 | add r5, r5, #SIZEOF_MACHINE_DESC @ next machine_desc | ||
| 520 | cmp r5, r6 | ||
| 521 | blo 1b | ||
| 522 | mov r5, #0 @ unknown machine | ||
| 523 | 2: mov pc, lr | ||
| 524 | |||
| 525 | /* | ||
| 526 | * This provides a C-API version of the above function. | ||
| 527 | */ | ||
| 528 | ENTRY(lookup_machine_type) | ||
| 529 | stmfd sp!, {r4 - r6, lr} | ||
| 530 | mov r1, r0 | ||
| 531 | bl __lookup_machine_type | ||
| 532 | mov r0, r5 | ||
| 533 | ldmfd sp!, {r4 - r6, pc} | ||
