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 18 28 /* !! 19 #include <asm/addrspace.h> 29 * This module contains the entry code for ker !! 20 #include <asm/asm.h> 30 * minimal setup needed to call the generic C !! 21 #include <asm/asmmacro.h> 31 * !! 22 #include <asm/irqflags.h> 32 * Prerequisites: !! 23 #include <asm/regdef.h> 33 * !! 24 #include <asm/mipsregs.h> 34 * - The kernel image has been loaded to the a !! 25 #include <asm/stackframe.h> 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 << 47 /* The first bytes of the kernel image << 48 * manually allocate and define the li << 49 * instruction. << 50 */ << 51 << 52 __HEAD << 53 .begin no-absolute-literals << 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 51 #endif >> 52 .endm 148 53 149 /* Disable all timers. */ !! 54 .macro setup_c0_status_sec 150 !! 55 #ifdef CONFIG_64BIT 151 .set _index, 0 !! 56 setup_c0_status ST0_KX ST0_BEV 152 .rept XCHAL_NUM_TIMERS !! 57 #else 153 wsr a0, SREG_CCOMPARE + _index !! 58 setup_c0_status 0 ST0_BEV 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 59 #endif >> 60 .endm 168 61 169 /* Initialize the caches. !! 62 #ifndef CONFIG_NO_EXCEPT_FILL 170 * a2, a3 are just working registers !! 63 /* >> 64 * Reserved space for exception handlers. >> 65 * Necessary for machines which link their kernels at KSEG0. 171 */ 66 */ 172 !! 67 .fill 0x400 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 68 #endif 180 69 181 ___invalidate_dcache_all a2 a3 !! 70 EXPORT(_stext) 182 ___invalidate_icache_all a2 a3 << 183 << 184 isync << 185 << 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 << 193 71 194 /* Setup stack and enable window excep !! 72 #ifdef CONFIG_BOOT_RAW 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 /* 73 /* 207 * Notice that we assume with SMP that !! 74 * Give us a fighting chance of running if execution beings at the 208 * supported by the cores. !! 75 * kernel load address. This is needed because this platform does >> 76 * not have a ELF loader yet. 209 */ 77 */ 210 rsr a2, prid !! 78 FEXPORT(__kernel_entry) 211 bnez a2, .Lboot_secondary !! 79 j kernel_entry 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 */ << 223 << 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 80 #endif 273 81 274 movi abi_arg0, 0 !! 82 __REF 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 << 285 #ifdef CONFIG_SMP << 286 .Lboot_secondary: << 287 << 288 movi a2, cpu_start_ccount << 289 1: << 290 memw << 291 l32i a3, a2, 0 << 292 beqi a3, 0, 1b << 293 movi a3, 0 << 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 83 307 abi_call secondary_start_kernel !! 84 NESTED(kernel_entry, 16, sp) # kernel entry point 308 j should_never_return << 309 85 310 #endif /* CONFIG_SMP */ !! 86 kernel_entry_setup # cpu specific setup 311 87 312 ENDPROC(_startup) !! 88 setup_c0_status_pri 313 89 314 #ifdef CONFIG_HOTPLUG_CPU !! 90 /* We might not get launched at the address the kernel is linked to, >> 91 so we jump there. */ >> 92 PTR_LA t0, 0f >> 93 jr t0 >> 94 0: 315 95 316 ENTRY(cpu_restart) !! 96 #ifdef CONFIG_USE_OF >> 97 #ifdef CONFIG_MIPS_RAW_APPENDED_DTB >> 98 PTR_LA t2, __appended_dtb 317 99 318 #if XCHAL_DCACHE_IS_WRITEBACK !! 100 #ifdef CONFIG_CPU_BIG_ENDIAN 319 ___flush_invalidate_dcache_all a2 a3 !! 101 li t1, 0xd00dfeed 320 #else 102 #else 321 ___invalidate_dcache_all a2 a3 !! 103 li t1, 0xedfe0dd0 >> 104 #endif >> 105 lw t0, (t2) >> 106 beq t0, t1, dtb_found 322 #endif 107 #endif 323 memw !! 108 li t1, -2 324 movi a2, CCON # MX External !! 109 move t2, a1 325 movi a3, 0 !! 110 beq a0, t1, dtb_found 326 wer a3, a2 !! 111 327 extw !! 112 li t2, 0 328 !! 113 dtb_found: 329 rsr a0, prid << 330 neg a2, a0 << 331 movi a3, cpu_start_id << 332 memw << 333 s32i a2, a3, 0 << 334 #if XCHAL_DCACHE_IS_WRITEBACK << 335 dhwbi a3, 0 << 336 #endif 114 #endif >> 115 PTR_LA t0, __bss_start # clear .bss >> 116 LONG_S zero, (t0) >> 117 PTR_LA t1, __bss_stop - LONGSIZE 337 1: 118 1: 338 memw !! 119 PTR_ADDIU t0, LONGSIZE 339 l32i a2, a3, 0 !! 120 LONG_S zero, (t0) 340 dhi a3, 0 !! 121 bne t0, t1, 1b 341 bne a2, a0, 1b !! 122 >> 123 LONG_S a0, fw_arg0 # firmware arguments >> 124 LONG_S a1, fw_arg1 >> 125 LONG_S a2, fw_arg2 >> 126 LONG_S a3, fw_arg3 >> 127 >> 128 #ifdef CONFIG_USE_OF >> 129 LONG_S t2, fw_passed_dtb >> 130 #endif >> 131 >> 132 MTC0 zero, CP0_CONTEXT # clear context register >> 133 PTR_LA $28, init_thread_union >> 134 /* Set the SP after an empty pt_regs. */ >> 135 PTR_LI sp, _THREAD_SIZE - 32 - PT_SIZE >> 136 PTR_ADDU sp, $28 >> 137 back_to_back_c0_hazard >> 138 set_saved_sp sp, t0, t1 >> 139 PTR_SUBU sp, 4 * SZREG # init stack pointer >> 140 >> 141 #ifdef CONFIG_RELOCATABLE >> 142 /* Copy kernel and apply the relocations */ >> 143 jal relocate_kernel >> 144 >> 145 /* Repoint the sp into the new kernel image */ >> 146 PTR_LI sp, _THREAD_SIZE - 32 - PT_SIZE >> 147 PTR_ADDU sp, $28 >> 148 set_saved_sp sp, t0, t1 >> 149 PTR_SUBU sp, 4 * SZREG # init stack pointer 342 150 343 /* 151 /* 344 * Initialize WB, WS, and clear PS.EXC !! 152 * relocate_kernel returns the entry point either 345 * Set Interrupt Level just below XCHA !! 153 * in the relocated kernel or the original if for 346 * xt-gdb to single step via DEBUG exc !! 154 * some reason relocation failed - jump there now 347 * by ocd. !! 155 * with instruction hazard barrier because of the >> 156 * newly sync'd icache. 348 */ 157 */ 349 movi a1, 1 !! 158 jr.hb v0 350 movi a0, 0 !! 159 #else 351 wsr a1, windowstart !! 160 j start_kernel 352 wsr a0, windowbase !! 161 #endif 353 rsync !! 162 END(kernel_entry) 354 << 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 163 >> 164 #ifdef CONFIG_SMP 374 /* 165 /* 375 * BSS section !! 166 * SMP slave cpus entry point. Board specific code for bootstrap calls this >> 167 * function after setting up the stack and gp registers. 376 */ 168 */ 377 !! 169 NESTED(smp_bootstrap, 16, sp) 378 __PAGE_ALIGNED_BSS !! 170 smp_slave_setup 379 #ifdef CONFIG_MMU !! 171 setup_c0_status_sec 380 ENTRY(swapper_pg_dir) !! 172 j start_secondary 381 .fill PAGE_SIZE, 1, 0 !! 173 END(smp_bootstrap) 382 END(swapper_pg_dir) !! 174 #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.