1 /* 1 /* 2 * arch/xtensa/kernel/head.S << 3 * << 4 * Xtensa Processor startup code. << 5 * << 6 * This file is subject to the terms and condi 2 * This file is subject to the terms and conditions of the GNU General Public 7 * License. See the file "COPYING" in the mai 3 * License. See the file "COPYING" in the main directory of this archive 8 * for more details. 4 * for more details. 9 * 5 * 10 * Copyright (C) 2001 - 2008 Tensilica Inc. !! 6 * Copyright (C) 1994, 1995 Waldorf Electronics 11 * !! 7 * Written by Ralf Baechle and Andreas Busse 12 * Chris Zankel <chris@zankel.net> !! 8 * Copyright (C) 1994 - 99, 2003, 06 Ralf Baechle 13 * Marc Gauthier <marc@tensilica.com, marc@alum !! 9 * Copyright (C) 1996 Paul M. Antoine 14 * Joe Taylor <joe@tensilica.com, joetylr@yahoo !! 10 * Modified for DECStation and hence R3000 support by Paul M. Antoine 15 * Kevin Chea !! 11 * Further modifications by David S. Miller and Harald Koerfgen >> 12 * Copyright (C) 1999 Silicon Graphics, Inc. >> 13 * Kevin Kissell, kevink@mips.com and Carsten Langgaard, carstenl@mips.com >> 14 * Copyright (C) 2000 MIPS Technologies, Inc. All rights reserved. 16 */ 15 */ 17 << 18 #include <asm/asmmacro.h> << 19 #include <asm/processor.h> << 20 #include <asm/page.h> << 21 #include <asm/cacheasm.h> << 22 #include <asm/initialize_mmu.h> << 23 #include <asm/mxregs.h> << 24 << 25 #include <linux/init.h> 16 #include <linux/init.h> 26 #include <linux/linkage.h> !! 17 #include <linux/threads.h> 27 << 28 /* << 29 * This module contains the entry code for ker << 30 * minimal setup needed to call the generic C << 31 * << 32 * Prerequisites: << 33 * << 34 * - The kernel image has been loaded to the a << 35 * compiled to. << 36 * - a2 contains either 0 or a pointer to a li << 37 * (see setup.c for more details) << 38 * << 39 */ << 40 << 41 /* << 42 * _start << 43 * << 44 * The bootloader passes a pointer to a list << 45 */ << 46 18 47 /* The first bytes of the kernel image !! 19 #include <asm/addrspace.h> 48 * manually allocate and define the li !! 20 #include <asm/asm.h> 49 * instruction. !! 21 #include <asm/asmmacro.h> 50 */ !! 22 #include <asm/irqflags.h> 51 !! 23 #include <asm/regdef.h> 52 __HEAD !! 24 #include <asm/mipsregs.h> 53 .begin no-absolute-literals !! 25 #include <asm/stackframe.h> 54 26 55 ENTRY(_start) !! 27 #include <kernel-entry-init.h> 56 28 57 /* Preserve the pointer to the boot pa << 58 wsr a2, excsave1 << 59 _j _SetupOCD << 60 << 61 .align 4 << 62 .literal_position << 63 _SetupOCD: << 64 /* 29 /* 65 * Initialize WB, WS, and clear PS.EXC !! 30 * For the moment disable interrupts, mark the kernel mode and 66 * Set Interrupt Level just below XCHA !! 31 * set ST0_KX so that the CPU does not spit fire when using 67 * xt-gdb to single step via DEBUG exc !! 32 * 64-bit addresses. A full initialization of the CPU's status 68 * by ocd. !! 33 * register is done later in per_cpu_trap_init(). 69 */ !! 34 */ 70 #if XCHAL_HAVE_WINDOWED !! 35 .macro setup_c0_status set clr 71 movi a1, 1 !! 36 .set push 72 movi a0, 0 !! 37 mfc0 t0, CP0_STATUS 73 wsr a1, windowstart !! 38 or t0, ST0_CU0|\set|0x1f|\clr 74 wsr a0, windowbase !! 39 xor t0, 0x1f|\clr 75 rsync !! 40 mtc0 t0, CP0_STATUS 76 #endif !! 41 .set noreorder 77 !! 42 sll zero,3 # ehb 78 movi a1, LOCKLEVEL !! 43 .set pop 79 wsr a1, ps !! 44 .endm 80 rsync !! 45 81 !! 46 .macro setup_c0_status_pri 82 .global _SetupMMU !! 47 #ifdef CONFIG_64BIT 83 _SetupMMU: !! 48 setup_c0_status ST0_KX 0 84 Offset = _SetupMMU - _start !! 49 #else 85 !! 50 setup_c0_status 0 0 86 #ifdef CONFIG_INITIALIZE_XTENSA_MMU_INSIDE_VML << 87 initialize_mmu << 88 #if defined(CONFIG_MMU) && XCHAL_HAVE_PTP_MMU << 89 rsr a2, excsave1 << 90 movi a3, XCHAL_KSEG_PADDR << 91 bltu a2, a3, 1f << 92 sub a2, a2, a3 << 93 movi a3, XCHAL_KSEG_SIZE << 94 bgeu a2, a3, 1f << 95 movi a3, XCHAL_KSEG_CACHED_VADDR << 96 add a2, a2, a3 << 97 wsr a2, excsave1 << 98 1: << 99 #endif << 100 #endif << 101 << 102 movi a0, _startup << 103 jx a0 << 104 << 105 ENDPROC(_start) << 106 .end no-absolute-literals << 107 << 108 __REF << 109 .literal_position << 110 << 111 ENTRY(_startup) << 112 << 113 /* Set a0 to 0 for the remaining initi << 114 << 115 movi a0, 0 << 116 << 117 #if XCHAL_HAVE_VECBASE << 118 movi a2, VECBASE_VADDR << 119 wsr a2, vecbase << 120 #endif << 121 << 122 /* Clear debugging registers. */ << 123 << 124 #if XCHAL_HAVE_DEBUG << 125 #if XCHAL_NUM_IBREAK > 0 << 126 wsr a0, ibreakenable << 127 #endif << 128 wsr a0, icount << 129 movi a1, 15 << 130 wsr a0, icountlevel << 131 << 132 .set _index, 0 << 133 .rept XCHAL_NUM_DBREAK << 134 wsr a0, SREG_DBREAKC + _index << 135 .set _index, _index + 1 << 136 .endr << 137 #endif << 138 << 139 /* Clear CCOUNT (not really necessary, << 140 << 141 wsr a0, ccount # not really n << 142 << 143 /* Disable zero-loops. */ << 144 << 145 #if XCHAL_HAVE_LOOPS << 146 wsr a0, lcount << 147 #endif << 148 << 149 /* Disable all timers. */ << 150 << 151 .set _index, 0 << 152 .rept XCHAL_NUM_TIMERS << 153 wsr a0, SREG_CCOMPARE + _index << 154 .set _index, _index + 1 << 155 .endr << 156 << 157 /* Interrupt initialization. */ << 158 << 159 movi a2, XCHAL_INTTYPE_MASK_SOFTWAR << 160 wsr a0, intenable << 161 wsr a2, intclear << 162 << 163 /* Disable coprocessors. */ << 164 << 165 #if XCHAL_HAVE_CP << 166 wsr a0, cpenable << 167 #endif << 168 << 169 /* Initialize the caches. << 170 * a2, a3 are just working registers << 171 */ << 172 << 173 #if XCHAL_DCACHE_LINE_LOCKABLE << 174 ___unlock_dcache_all a2 a3 << 175 #endif << 176 << 177 #if XCHAL_ICACHE_LINE_LOCKABLE << 178 ___unlock_icache_all a2 a3 << 179 #endif 51 #endif >> 52 .endm 180 53 181 ___invalidate_dcache_all a2 a3 !! 54 .macro setup_c0_status_sec 182 ___invalidate_icache_all a2 a3 !! 55 #ifdef CONFIG_64BIT 183 !! 56 setup_c0_status ST0_KX ST0_BEV 184 isync !! 57 #else 185 !! 58 setup_c0_status 0 ST0_BEV 186 initialize_cacheattr << 187 << 188 #ifdef CONFIG_HAVE_SMP << 189 movi a2, CCON # MX External << 190 movi a3, 1 << 191 wer a3, a2 << 192 #endif 59 #endif >> 60 .endm 193 61 194 /* Setup stack and enable window excep !! 62 #ifndef CONFIG_NO_EXCEPT_FILL 195 << 196 movi a1, start_info << 197 l32i a1, a1, 0 << 198 << 199 /* Disable interrupts. */ << 200 /* Enable window exceptions if kernel << 201 movi a2, KERNEL_PS_WOE_MASK | LOCKL << 202 wsr a2, ps << 203 rsync << 204 << 205 #ifdef CONFIG_SMP << 206 /* 63 /* 207 * Notice that we assume with SMP that !! 64 * Reserved space for exception handlers. 208 * supported by the cores. !! 65 * Necessary for machines which link their kernels at KSEG0. 209 */ << 210 rsr a2, prid << 211 bnez a2, .Lboot_secondary << 212 << 213 #endif /* CONFIG_SMP */ << 214 << 215 /* Unpack data sections << 216 * << 217 * The linker script used to build the << 218 * creates a table located at __boot_r << 219 * that contains the information what << 220 * << 221 * Uses a2-a7. << 222 */ 66 */ 223 !! 67 .fill 0x400 224 movi a2, __boot_reloc_table_start << 225 movi a3, __boot_reloc_table_end << 226 << 227 1: beq a2, a3, 3f # no more entr << 228 l32i a4, a2, 0 # start destin << 229 l32i a5, a2, 4 # end destinat << 230 l32i a6, a2, 8 # start source << 231 addi a2, a2, 12 # next entry << 232 beq a4, a5, 1b # skip, empty << 233 beq a4, a6, 1b # skip, source << 234 << 235 2: l32i a7, a6, 0 # load word << 236 addi a6, a6, 4 << 237 s32i a7, a4, 0 # store word << 238 addi a4, a4, 4 << 239 bltu a4, a5, 2b << 240 j 1b << 241 << 242 3: << 243 /* All code and initialized data segme << 244 * Now clear the BSS segment. << 245 */ << 246 << 247 movi a2, __bss_start # start of BSS << 248 movi a3, __bss_stop # end of BSS << 249 << 250 __loopt a2, a3, a4, 2 << 251 s32i a0, a2, 0 << 252 __endla a2, a3, 4 << 253 << 254 #if XCHAL_DCACHE_IS_WRITEBACK << 255 << 256 /* After unpacking, flush the writebac << 257 * instructions/data are available. << 258 */ << 259 << 260 ___flush_dcache_all a2 a3 << 261 #endif << 262 memw << 263 isync << 264 ___invalidate_icache_all a2 a3 << 265 isync << 266 << 267 #ifdef CONFIG_XIP_KERNEL << 268 /* Setup bootstrap CPU stack in XIP ke << 269 << 270 movi a1, start_info << 271 l32i a1, a1, 0 << 272 #endif 68 #endif 273 69 274 movi abi_arg0, 0 !! 70 EXPORT(_stext) 275 xsr abi_arg0, excsave1 << 276 << 277 /* init_arch kick-starts the linux ker << 278 << 279 abi_call init_arch << 280 abi_call start_kernel << 281 << 282 should_never_return: << 283 j should_never_return << 284 71 285 #ifdef CONFIG_SMP !! 72 #ifdef CONFIG_BOOT_RAW 286 .Lboot_secondary: !! 73 /* 287 !! 74 * Give us a fighting chance of running if execution beings at the 288 movi a2, cpu_start_ccount !! 75 * kernel load address. This is needed because this platform does 289 1: !! 76 * not have a ELF loader yet. 290 memw !! 77 */ 291 l32i a3, a2, 0 !! 78 FEXPORT(__kernel_entry) 292 beqi a3, 0, 1b !! 79 j kernel_entry 293 movi a3, 0 !! 80 #endif /* CONFIG_BOOT_RAW */ 294 s32i a3, a2, 0 << 295 1: << 296 memw << 297 l32i a3, a2, 0 << 298 beqi a3, 0, 1b << 299 wsr a3, ccount << 300 movi a3, 0 << 301 s32i a3, a2, 0 << 302 memw << 303 << 304 movi abi_arg0, 0 << 305 wsr abi_arg0, excsave1 << 306 << 307 abi_call secondary_start_kernel << 308 j should_never_return << 309 81 310 #endif /* CONFIG_SMP */ !! 82 __REF 311 83 312 ENDPROC(_startup) !! 84 NESTED(kernel_entry, 16, sp) # kernel entry point 313 85 314 #ifdef CONFIG_HOTPLUG_CPU !! 86 kernel_entry_setup # cpu specific setup 315 87 316 ENTRY(cpu_restart) !! 88 setup_c0_status_pri 317 89 318 #if XCHAL_DCACHE_IS_WRITEBACK !! 90 /* We might not get launched at the address the kernel is linked to, 319 ___flush_invalidate_dcache_all a2 a3 !! 91 so we jump there. */ 320 #else !! 92 PTR_LA t0, 0f 321 ___invalidate_dcache_all a2 a3 !! 93 jr t0 322 #endif !! 94 0: 323 memw !! 95 324 movi a2, CCON # MX External !! 96 #ifdef CONFIG_USE_OF 325 movi a3, 0 !! 97 #if defined(CONFIG_MIPS_RAW_APPENDED_DTB) || \ 326 wer a3, a2 !! 98 defined(CONFIG_MIPS_ELF_APPENDED_DTB) 327 extw !! 99 328 !! 100 PTR_LA t2, __appended_dtb 329 rsr a0, prid !! 101 330 neg a2, a0 !! 102 #ifdef CONFIG_CPU_BIG_ENDIAN 331 movi a3, cpu_start_id !! 103 li t1, 0xd00dfeed 332 memw !! 104 #else /* !CONFIG_CPU_BIG_ENDIAN */ 333 s32i a2, a3, 0 !! 105 li t1, 0xedfe0dd0 334 #if XCHAL_DCACHE_IS_WRITEBACK !! 106 #endif /* !CONFIG_CPU_BIG_ENDIAN */ 335 dhwbi a3, 0 !! 107 lw t0, (t2) 336 #endif !! 108 beq t0, t1, dtb_found >> 109 #endif /* CONFIG_MIPS_RAW_APPENDED_DTB || CONFIG_MIPS_ELF_APPENDED_DTB */ >> 110 li t1, -2 >> 111 move t2, a1 >> 112 beq a0, t1, dtb_found >> 113 >> 114 li t2, 0 >> 115 dtb_found: >> 116 #endif /* CONFIG_USE_OF */ >> 117 PTR_LA t0, __bss_start # clear .bss >> 118 LONG_S zero, (t0) >> 119 PTR_LA t1, __bss_stop - LONGSIZE 337 1: 120 1: 338 memw !! 121 PTR_ADDIU t0, LONGSIZE 339 l32i a2, a3, 0 !! 122 LONG_S zero, (t0) 340 dhi a3, 0 !! 123 bne t0, t1, 1b 341 bne a2, a0, 1b !! 124 >> 125 LONG_S a0, fw_arg0 # firmware arguments >> 126 LONG_S a1, fw_arg1 >> 127 LONG_S a2, fw_arg2 >> 128 LONG_S a3, fw_arg3 >> 129 >> 130 #ifdef CONFIG_USE_OF >> 131 LONG_S t2, fw_passed_dtb >> 132 #endif >> 133 >> 134 MTC0 zero, CP0_CONTEXT # clear context register >> 135 PTR_LA $28, init_thread_union >> 136 /* Set the SP after an empty pt_regs. */ >> 137 PTR_LI sp, _THREAD_SIZE - 32 - PT_SIZE >> 138 PTR_ADDU sp, $28 >> 139 back_to_back_c0_hazard >> 140 set_saved_sp sp, t0, t1 >> 141 PTR_SUBU sp, 4 * SZREG # init stack pointer >> 142 >> 143 #ifdef CONFIG_RELOCATABLE >> 144 /* Copy kernel and apply the relocations */ >> 145 jal relocate_kernel >> 146 >> 147 /* Repoint the sp into the new kernel image */ >> 148 PTR_LI sp, _THREAD_SIZE - 32 - PT_SIZE >> 149 PTR_ADDU sp, $28 >> 150 set_saved_sp sp, t0, t1 >> 151 PTR_SUBU sp, 4 * SZREG # init stack pointer 342 152 343 /* 153 /* 344 * Initialize WB, WS, and clear PS.EXC !! 154 * relocate_kernel returns the entry point either 345 * Set Interrupt Level just below XCHA !! 155 * in the relocated kernel or the original if for 346 * xt-gdb to single step via DEBUG exc !! 156 * some reason relocation failed - jump there now 347 * by ocd. !! 157 * with instruction hazard barrier because of the 348 */ !! 158 * newly sync'd icache. 349 movi a1, 1 !! 159 */ 350 movi a0, 0 !! 160 jr.hb v0 351 wsr a1, windowstart !! 161 #else /* !CONFIG_RELOCATABLE */ 352 wsr a0, windowbase !! 162 j start_kernel 353 rsync !! 163 #endif /* !CONFIG_RELOCATABLE */ 354 !! 164 END(kernel_entry) 355 movi a1, LOCKLEVEL << 356 wsr a1, ps << 357 rsync << 358 << 359 j _startup << 360 << 361 ENDPROC(cpu_restart) << 362 << 363 #endif /* CONFIG_HOTPLUG_CPU */ << 364 << 365 /* << 366 * DATA section << 367 */ << 368 << 369 __REFDATA << 370 .align 4 << 371 ENTRY(start_info) << 372 .long init_thread_union + KERNEL_STA << 373 165 >> 166 #ifdef CONFIG_SMP 374 /* 167 /* 375 * BSS section !! 168 * SMP slave cpus entry point. Board specific code for bootstrap calls this >> 169 * function after setting up the stack and gp registers. 376 */ 170 */ 377 !! 171 NESTED(smp_bootstrap, 16, sp) 378 __PAGE_ALIGNED_BSS !! 172 smp_slave_setup 379 #ifdef CONFIG_MMU !! 173 setup_c0_status_sec 380 ENTRY(swapper_pg_dir) !! 174 j start_secondary 381 .fill PAGE_SIZE, 1, 0 !! 175 END(smp_bootstrap) 382 END(swapper_pg_dir) !! 176 #endif /* CONFIG_SMP */ 383 #endif << 384 ENTRY(empty_zero_page) << 385 .fill PAGE_SIZE, 1, 0 << 386 END(empty_zero_page) <<
Linux® is a registered trademark of Linus Torvalds in the United States and other countries.
TOMOYO® is a registered trademark of NTT DATA CORPORATION.