Fix common misspellings
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / arch / powerpc / kernel / head_64.S
CommitLineData
14cf11af 1/*
14cf11af
PM
2 * PowerPC version
3 * Copyright (C) 1995-1996 Gary Thomas (gdt@linuxppc.org)
4 *
5 * Rewritten by Cort Dougan (cort@cs.nmt.edu) for PReP
6 * Copyright (C) 1996 Cort Dougan <cort@cs.nmt.edu>
7 * Adapted for Power Macintosh by Paul Mackerras.
8 * Low-level exception handlers and MMU support
9 * rewritten by Paul Mackerras.
10 * Copyright (C) 1996 Paul Mackerras.
11 *
12 * Adapted for 64bit PowerPC by Dave Engebretsen, Peter Bergner, and
13 * Mike Corrigan {engebret|bergner|mikejc}@us.ibm.com
14 *
0ebc4cda
BH
15 * This file contains the entry point for the 64-bit kernel along
16 * with some early initialization code common to all 64-bit powerpc
17 * variants.
14cf11af
PM
18 *
19 * This program is free software; you can redistribute it and/or
20 * modify it under the terms of the GNU General Public License
21 * as published by the Free Software Foundation; either version
22 * 2 of the License, or (at your option) any later version.
23 */
24
14cf11af 25#include <linux/threads.h>
b5bbeb23 26#include <asm/reg.h>
14cf11af
PM
27#include <asm/page.h>
28#include <asm/mmu.h>
14cf11af
PM
29#include <asm/ppc_asm.h>
30#include <asm/asm-offsets.h>
31#include <asm/bug.h>
32#include <asm/cputable.h>
33#include <asm/setup.h>
34#include <asm/hvcall.h>
c43a55ff 35#include <asm/iseries/lpar_map.h>
6cb7bfeb 36#include <asm/thread_info.h>
3f639ee8 37#include <asm/firmware.h>
16a15a30 38#include <asm/page_64.h>
945feb17 39#include <asm/irqflags.h>
2191d657 40#include <asm/kvm_book3s_asm.h>
46f52210 41#include <asm/ptrace.h>
14cf11af 42
25985edc 43/* The physical memory is laid out such that the secondary processor
0ebc4cda
BH
44 * spin code sits at 0x0000...0x00ff. On server, the vectors follow
45 * using the layout described in exceptions-64s.S
14cf11af
PM
46 */
47
48/*
49 * Entering into this code we make the following assumptions:
0ebc4cda
BH
50 *
51 * For pSeries or server processors:
14cf11af
PM
52 * 1. The MMU is off & open firmware is running in real mode.
53 * 2. The kernel is entered at __start
54 *
55 * For iSeries:
56 * 1. The MMU is on (as it always is for iSeries)
57 * 2. The kernel is entered at system_reset_iSeries
0ebc4cda
BH
58 *
59 * For Book3E processors:
60 * 1. The MMU is on running in AS0 in a state defined in ePAPR
61 * 2. The kernel is entered at __start
14cf11af
PM
62 */
63
64 .text
65 .globl _stext
66_stext:
14cf11af
PM
67_GLOBAL(__start)
68 /* NOP this out unconditionally */
69BEGIN_FTR_SECTION
b85a046a 70 b .__start_initialization_multiplatform
14cf11af 71END_FTR_SECTION(0, 1)
14cf11af
PM
72
73 /* Catch branch to 0 in real mode */
74 trap
75
1f6a93e4
PM
76 /* Secondary processors spin on this value until it becomes nonzero.
77 * When it does it contains the real address of the descriptor
78 * of the function that the cpu should jump to to continue
79 * initialization.
80 */
14cf11af
PM
81 .globl __secondary_hold_spinloop
82__secondary_hold_spinloop:
83 .llong 0x0
84
85 /* Secondary processors write this value with their cpu # */
86 /* after they enter the spin loop immediately below. */
87 .globl __secondary_hold_acknowledge
88__secondary_hold_acknowledge:
89 .llong 0x0
90
1dce0e30
ME
91#ifdef CONFIG_PPC_ISERIES
92 /*
93 * At offset 0x20, there is a pointer to iSeries LPAR data.
94 * This is required by the hypervisor
95 */
96 . = 0x20
97 .llong hvReleaseData-KERNELBASE
98#endif /* CONFIG_PPC_ISERIES */
99
928a3197 100#ifdef CONFIG_RELOCATABLE
8b8b0cc1
MM
101 /* This flag is set to 1 by a loader if the kernel should run
102 * at the loaded address instead of the linked address. This
103 * is used by kexec-tools to keep the the kdump kernel in the
104 * crash_kernel region. The loader is responsible for
105 * observing the alignment requirement.
106 */
107 /* Do not move this variable as kexec-tools knows about it. */
108 . = 0x5c
109 .globl __run_at_load
110__run_at_load:
111 .long 0x72756e30 /* "run0" -- relocate to 0 by default */
112#endif
113
14cf11af
PM
114 . = 0x60
115/*
75423b7b
GL
116 * The following code is used to hold secondary processors
117 * in a spin loop after they have entered the kernel, but
14cf11af
PM
118 * before the bulk of the kernel has been relocated. This code
119 * is relocated to physical address 0x60 before prom_init is run.
120 * All of it must fit below the first exception vector at 0x100.
1f6a93e4
PM
121 * Use .globl here not _GLOBAL because we want __secondary_hold
122 * to be the actual text address, not a descriptor.
14cf11af 123 */
1f6a93e4
PM
124 .globl __secondary_hold
125__secondary_hold:
2d27cfd3 126#ifndef CONFIG_PPC_BOOK3E
14cf11af
PM
127 mfmsr r24
128 ori r24,r24,MSR_RI
129 mtmsrd r24 /* RI on */
2d27cfd3 130#endif
f1870f77 131 /* Grab our physical cpu number */
14cf11af
PM
132 mr r24,r3
133
134 /* Tell the master cpu we're here */
135 /* Relocation is off & we are located at an address less */
136 /* than 0x100, so only need to grab low order offset. */
e31aa453 137 std r24,__secondary_hold_acknowledge-_stext(0)
14cf11af
PM
138 sync
139
140 /* All secondary cpus wait here until told to start. */
e31aa453 141100: ld r4,__secondary_hold_spinloop-_stext(0)
1f6a93e4
PM
142 cmpdi 0,r4,0
143 beq 100b
14cf11af 144
f1870f77 145#if defined(CONFIG_SMP) || defined(CONFIG_KEXEC)
1f6a93e4 146 ld r4,0(r4) /* deref function descriptor */
758438a7 147 mtctr r4
14cf11af 148 mr r3,r24
2d27cfd3 149 li r4,0
758438a7 150 bctr
14cf11af
PM
151#else
152 BUG_OPCODE
153#endif
14cf11af
PM
154
155/* This value is used to mark exception frames on the stack. */
156 .section ".toc","aw"
157exception_marker:
158 .tc ID_72656773_68657265[TC],0x7265677368657265
159 .text
160
14cf11af 161/*
0ebc4cda
BH
162 * On server, we include the exception vectors code here as it
163 * relies on absolute addressing which is only possible within
164 * this compilation unit
3c726f8d 165 */
0ebc4cda
BH
166#ifdef CONFIG_PPC_BOOK3S
167#include "exceptions-64s.S"
1f6a93e4 168#endif
3c726f8d 169
2d27cfd3
BH
170_GLOBAL(generic_secondary_thread_init)
171 mr r24,r3
172
173 /* turn on 64-bit mode */
174 bl .enable_64b_mode
175
176 /* get a valid TOC pointer, wherever we're mapped at */
177 bl .relative_toc
178
179#ifdef CONFIG_PPC_BOOK3E
180 /* Book3E initialization */
181 mr r3,r24
182 bl .book3e_secondary_thread_init
183#endif
184 b generic_secondary_common_init
14cf11af
PM
185
186/*
f39b7a55
OJ
187 * On pSeries and most other platforms, secondary processors spin
188 * in the following code.
14cf11af 189 * At entry, r3 = this processor's number (physical cpu id)
2d27cfd3
BH
190 *
191 * On Book3E, r4 = 1 to indicate that the initial TLB entry for
192 * this core already exists (setup via some other mechanism such
193 * as SCOM before entry).
14cf11af 194 */
f39b7a55 195_GLOBAL(generic_secondary_smp_init)
14cf11af 196 mr r24,r3
2d27cfd3
BH
197 mr r25,r4
198
14cf11af
PM
199 /* turn on 64-bit mode */
200 bl .enable_64b_mode
14cf11af 201
2d27cfd3 202 /* get a valid TOC pointer, wherever we're mapped at */
e31aa453
PM
203 bl .relative_toc
204
2d27cfd3
BH
205#ifdef CONFIG_PPC_BOOK3E
206 /* Book3E initialization */
207 mr r3,r24
208 mr r4,r25
209 bl .book3e_secondary_core_init
210#endif
211
212generic_secondary_common_init:
14cf11af
PM
213 /* Set up a paca value for this processor. Since we have the
214 * physical cpu id in r24, we need to search the pacas to find
215 * which logical id maps to our physical one.
216 */
1426d5a3
ME
217 LOAD_REG_ADDR(r13, paca) /* Load paca pointer */
218 ld r13,0(r13) /* Get base vaddr of paca array */
14cf11af
PM
219 li r5,0 /* logical cpu id */
2201: lhz r6,PACAHWCPUID(r13) /* Load HW procid from paca */
221 cmpw r6,r24 /* Compare to our id */
222 beq 2f
223 addi r13,r13,PACA_SIZE /* Loop to next PACA on miss */
224 addi r5,r5,1
225 cmpwi r5,NR_CPUS
226 blt 1b
227
228 mr r3,r24 /* not found, copy phys to r3 */
229 b .kexec_wait /* next kernel might do better */
230
ee43eb78 2312: mtspr SPRN_SPRG_PACA,r13 /* Save vaddr of paca in an SPRG */
2d27cfd3
BH
232#ifdef CONFIG_PPC_BOOK3E
233 addi r12,r13,PACA_EXTLB /* and TLB exc frame in another */
234 mtspr SPRN_SPRG_TLB_EXFRAME,r12
235#endif
236
14cf11af
PM
237 /* From now on, r24 is expected to be logical cpuid */
238 mr r24,r5
2393: HMT_LOW
240 lbz r23,PACAPROCSTART(r13) /* Test if this processor should */
241 /* start. */
14cf11af 242
f39b7a55
OJ
243#ifndef CONFIG_SMP
244 b 3b /* Never go on non-SMP */
245#else
246 cmpwi 0,r23,0
247 beq 3b /* Loop until told to go */
248
b6f6b98a
SR
249 sync /* order paca.run and cur_cpu_spec */
250
f39b7a55 251 /* See if we need to call a cpu state restore handler */
e31aa453 252 LOAD_REG_ADDR(r23, cur_cpu_spec)
f39b7a55
OJ
253 ld r23,0(r23)
254 ld r23,CPU_SPEC_RESTORE(r23)
255 cmpdi 0,r23,0
256 beq 4f
257 ld r23,0(r23)
258 mtctr r23
259 bctrl
260
2614: /* Create a temp kernel stack for use before relocation is on. */
14cf11af
PM
262 ld r1,PACAEMERGSP(r13)
263 subi r1,r1,STACK_FRAME_OVERHEAD
264
c705677e 265 b __secondary_start
14cf11af 266#endif
14cf11af 267
e31aa453
PM
268/*
269 * Turn the MMU off.
270 * Assumes we're mapped EA == RA if the MMU is on.
271 */
2d27cfd3 272#ifdef CONFIG_PPC_BOOK3S
14cf11af
PM
273_STATIC(__mmu_off)
274 mfmsr r3
275 andi. r0,r3,MSR_IR|MSR_DR
276 beqlr
e31aa453 277 mflr r4
14cf11af
PM
278 andc r3,r3,r0
279 mtspr SPRN_SRR0,r4
280 mtspr SPRN_SRR1,r3
281 sync
282 rfid
283 b . /* prevent speculative execution */
2d27cfd3 284#endif
14cf11af
PM
285
286
287/*
288 * Here is our main kernel entry point. We support currently 2 kind of entries
289 * depending on the value of r5.
290 *
291 * r5 != NULL -> OF entry, we go to prom_init, "legacy" parameter content
292 * in r3...r7
293 *
294 * r5 == NULL -> kexec style entry. r3 is a physical pointer to the
295 * DT block, r4 is a physical pointer to the kernel itself
296 *
297 */
298_GLOBAL(__start_initialization_multiplatform)
e31aa453
PM
299 /* Make sure we are running in 64 bits mode */
300 bl .enable_64b_mode
301
302 /* Get TOC pointer (current runtime address) */
303 bl .relative_toc
304
305 /* find out where we are now */
306 bcl 20,31,$+4
3070: mflr r26 /* r26 = runtime addr here */
308 addis r26,r26,(_stext - 0b)@ha
309 addi r26,r26,(_stext - 0b)@l /* current runtime base addr */
310
14cf11af
PM
311 /*
312 * Are we booted from a PROM Of-type client-interface ?
313 */
314 cmpldi cr0,r5,0
939e60f6
SR
315 beq 1f
316 b .__boot_from_prom /* yes -> prom */
3171:
14cf11af
PM
318 /* Save parameters */
319 mr r31,r3
320 mr r30,r4
321
2d27cfd3
BH
322#ifdef CONFIG_PPC_BOOK3E
323 bl .start_initialization_book3e
324 b .__after_prom_start
325#else
14cf11af 326 /* Setup some critical 970 SPRs before switching MMU off */
f39b7a55
OJ
327 mfspr r0,SPRN_PVR
328 srwi r0,r0,16
329 cmpwi r0,0x39 /* 970 */
330 beq 1f
331 cmpwi r0,0x3c /* 970FX */
332 beq 1f
333 cmpwi r0,0x44 /* 970MP */
190a24f5
OJ
334 beq 1f
335 cmpwi r0,0x45 /* 970GX */
f39b7a55
OJ
336 bne 2f
3371: bl .__cpu_preinit_ppc970
3382:
14cf11af 339
e31aa453 340 /* Switch off MMU if not already off */
14cf11af
PM
341 bl .__mmu_off
342 b .__after_prom_start
2d27cfd3 343#endif /* CONFIG_PPC_BOOK3E */
14cf11af 344
939e60f6 345_INIT_STATIC(__boot_from_prom)
28794d34 346#ifdef CONFIG_PPC_OF_BOOT_TRAMPOLINE
14cf11af
PM
347 /* Save parameters */
348 mr r31,r3
349 mr r30,r4
350 mr r29,r5
351 mr r28,r6
352 mr r27,r7
353
6088857b
OH
354 /*
355 * Align the stack to 16-byte boundary
356 * Depending on the size and layout of the ELF sections in the initial
e31aa453 357 * boot binary, the stack pointer may be unaligned on PowerMac
6088857b 358 */
c05b4770
LT
359 rldicr r1,r1,0,59
360
549e8152
PM
361#ifdef CONFIG_RELOCATABLE
362 /* Relocate code for where we are now */
363 mr r3,r26
364 bl .relocate
365#endif
366
14cf11af
PM
367 /* Restore parameters */
368 mr r3,r31
369 mr r4,r30
370 mr r5,r29
371 mr r6,r28
372 mr r7,r27
373
374 /* Do all of the interaction with OF client interface */
549e8152 375 mr r8,r26
14cf11af 376 bl .prom_init
28794d34
BH
377#endif /* #CONFIG_PPC_OF_BOOT_TRAMPOLINE */
378
379 /* We never return. We also hit that trap if trying to boot
380 * from OF while CONFIG_PPC_OF_BOOT_TRAMPOLINE isn't selected */
14cf11af
PM
381 trap
382
14cf11af 383_STATIC(__after_prom_start)
549e8152
PM
384#ifdef CONFIG_RELOCATABLE
385 /* process relocations for the final address of the kernel */
386 lis r25,PAGE_OFFSET@highest /* compute virtual base of kernel */
387 sldi r25,r25,32
8b8b0cc1 388 lwz r7,__run_at_load-_stext(r26)
928a3197 389 cmplwi cr0,r7,1 /* flagged to stay where we are ? */
54622f10
MK
390 bne 1f
391 add r25,r25,r26
54622f10 3921: mr r3,r25
549e8152
PM
393 bl .relocate
394#endif
14cf11af
PM
395
396/*
e31aa453 397 * We need to run with _stext at physical address PHYSICAL_START.
14cf11af
PM
398 * This will leave some code in the first 256B of
399 * real memory, which are reserved for software use.
14cf11af
PM
400 *
401 * Note: This process overwrites the OF exception vectors.
14cf11af 402 */
549e8152 403 li r3,0 /* target addr */
2d27cfd3
BH
404#ifdef CONFIG_PPC_BOOK3E
405 tovirt(r3,r3) /* on booke, we already run at PAGE_OFFSET */
406#endif
549e8152 407 mr. r4,r26 /* In some cases the loader may */
e31aa453 408 beq 9f /* have already put us at zero */
14cf11af
PM
409 li r6,0x100 /* Start offset, the first 0x100 */
410 /* bytes were copied earlier. */
2d27cfd3
BH
411#ifdef CONFIG_PPC_BOOK3E
412 tovirt(r6,r6) /* on booke, we already run at PAGE_OFFSET */
413#endif
14cf11af 414
54622f10
MK
415#ifdef CONFIG_CRASH_DUMP
416/*
417 * Check if the kernel has to be running as relocatable kernel based on the
8b8b0cc1 418 * variable __run_at_load, if it is set the kernel is treated as relocatable
54622f10
MK
419 * kernel, otherwise it will be moved to PHYSICAL_START
420 */
8b8b0cc1
MM
421 lwz r7,__run_at_load-_stext(r26)
422 cmplwi cr0,r7,1
54622f10
MK
423 bne 3f
424
425 li r5,__end_interrupts - _stext /* just copy interrupts */
426 b 5f
4273:
428#endif
429 lis r5,(copy_to_here - _stext)@ha
430 addi r5,r5,(copy_to_here - _stext)@l /* # bytes of memory to copy */
431
14cf11af
PM
432 bl .copy_and_flush /* copy the first n bytes */
433 /* this includes the code being */
434 /* executed here. */
e31aa453
PM
435 addis r8,r3,(4f - _stext)@ha /* Jump to the copy of this code */
436 addi r8,r8,(4f - _stext)@l /* that we just made */
437 mtctr r8
14cf11af
PM
438 bctr
439
54622f10
MK
440p_end: .llong _end - _stext
441
e31aa453
PM
4424: /* Now copy the rest of the kernel up to _end */
443 addis r5,r26,(p_end - _stext)@ha
444 ld r5,(p_end - _stext)@l(r5) /* get _end */
54622f10 4455: bl .copy_and_flush /* copy the rest */
e31aa453
PM
446
4479: b .start_here_multiplatform
448
14cf11af
PM
449/*
450 * Copy routine used to copy the kernel to start at physical address 0
451 * and flush and invalidate the caches as needed.
452 * r3 = dest addr, r4 = source addr, r5 = copy limit, r6 = start offset
453 * on exit, r3, r4, r5 are unchanged, r6 is updated to be >= r5.
454 *
455 * Note: this routine *only* clobbers r0, r6 and lr
456 */
457_GLOBAL(copy_and_flush)
458 addi r5,r5,-8
459 addi r6,r6,-8
5a2fe38d 4604: li r0,8 /* Use the smallest common */
14cf11af
PM
461 /* denominator cache line */
462 /* size. This results in */
463 /* extra cache line flushes */
464 /* but operation is correct. */
465 /* Can't get cache line size */
466 /* from NACA as it is being */
467 /* moved too. */
468
469 mtctr r0 /* put # words/line in ctr */
4703: addi r6,r6,8 /* copy a cache line */
471 ldx r0,r6,r4
472 stdx r0,r6,r3
473 bdnz 3b
474 dcbst r6,r3 /* write it to memory */
475 sync
476 icbi r6,r3 /* flush the icache line */
477 cmpld 0,r6,r5
478 blt 4b
479 sync
480 addi r5,r5,8
481 addi r6,r6,8
482 blr
483
484.align 8
485copy_to_here:
486
487#ifdef CONFIG_SMP
488#ifdef CONFIG_PPC_PMAC
489/*
490 * On PowerMac, secondary processors starts from the reset vector, which
491 * is temporarily turned into a call to one of the functions below.
492 */
493 .section ".text";
494 .align 2 ;
495
35499c01
PM
496 .globl __secondary_start_pmac_0
497__secondary_start_pmac_0:
498 /* NB the entries for cpus 0, 1, 2 must each occupy 8 bytes. */
499 li r24,0
500 b 1f
501 li r24,1
502 b 1f
503 li r24,2
504 b 1f
505 li r24,3
5061:
14cf11af
PM
507
508_GLOBAL(pmac_secondary_start)
509 /* turn on 64-bit mode */
510 bl .enable_64b_mode
14cf11af 511
c478b581
BH
512 li r0,0
513 mfspr r3,SPRN_HID4
514 rldimi r3,r0,40,23 /* clear bit 23 (rm_ci) */
515 sync
516 mtspr SPRN_HID4,r3
517 isync
518 sync
519 slbia
520
e31aa453
PM
521 /* get TOC pointer (real address) */
522 bl .relative_toc
523
14cf11af 524 /* Copy some CPU settings from CPU 0 */
f39b7a55 525 bl .__restore_cpu_ppc970
14cf11af
PM
526
527 /* pSeries do that early though I don't think we really need it */
528 mfmsr r3
529 ori r3,r3,MSR_RI
530 mtmsrd r3 /* RI on */
531
532 /* Set up a paca value for this processor. */
1426d5a3
ME
533 LOAD_REG_ADDR(r4,paca) /* Load paca pointer */
534 ld r4,0(r4) /* Get base vaddr of paca array */
e31aa453 535 mulli r13,r24,PACA_SIZE /* Calculate vaddr of right paca */
14cf11af 536 add r13,r13,r4 /* for this processor. */
ee43eb78 537 mtspr SPRN_SPRG_PACA,r13 /* Save vaddr of paca in an SPRG*/
14cf11af
PM
538
539 /* Create a temp kernel stack for use before relocation is on. */
540 ld r1,PACAEMERGSP(r13)
541 subi r1,r1,STACK_FRAME_OVERHEAD
542
c705677e 543 b __secondary_start
14cf11af
PM
544
545#endif /* CONFIG_PPC_PMAC */
546
547/*
548 * This function is called after the master CPU has released the
549 * secondary processors. The execution environment is relocation off.
550 * The paca for this processor has the following fields initialized at
551 * this point:
552 * 1. Processor number
553 * 2. Segment table pointer (virtual address)
554 * On entry the following are set:
ee43eb78
BH
555 * r1 = stack pointer. vaddr for iSeries, raddr (temp stack) for pSeries
556 * r24 = cpu# (in Linux terms)
557 * r13 = paca virtual address
558 * SPRG_PACA = paca virtual address
14cf11af 559 */
2d27cfd3
BH
560 .section ".text";
561 .align 2 ;
562
fc68e869 563 .globl __secondary_start
c705677e 564__secondary_start:
799d6046
PM
565 /* Set thread priority to MEDIUM */
566 HMT_MEDIUM
14cf11af 567
14cf11af 568 /* Initialize the kernel stack. Just a repeat for iSeries. */
e58c3495 569 LOAD_REG_ADDR(r3, current_set)
14cf11af 570 sldi r28,r24,3 /* get current_set[cpu#] */
54a83404
MN
571 ldx r14,r3,r28
572 addi r14,r14,THREAD_SIZE-STACK_FRAME_OVERHEAD
573 std r14,PACAKSAVE(r13)
14cf11af 574
f761622e
ME
575 /* Do early setup for that CPU (stab, slb, hash table pointer) */
576 bl .early_setup_secondary
577
54a83404
MN
578 /*
579 * setup the new stack pointer, but *don't* use this until
580 * translation is on.
581 */
582 mr r1, r14
583
799d6046 584 /* Clear backchain so we get nice backtraces */
14cf11af
PM
585 li r7,0
586 mtlr r7
587
588 /* enable MMU and jump to start_secondary */
e58c3495
DG
589 LOAD_REG_ADDR(r3, .start_secondary_prolog)
590 LOAD_REG_IMMEDIATE(r4, MSR_KERNEL)
d04c56f7 591#ifdef CONFIG_PPC_ISERIES
3f639ee8 592BEGIN_FW_FTR_SECTION
14cf11af 593 ori r4,r4,MSR_EE
ff3da2e0
BH
594 li r8,1
595 stb r8,PACAHARDIRQEN(r13)
3f639ee8 596END_FW_FTR_SECTION_IFSET(FW_FEATURE_ISERIES)
14cf11af 597#endif
d04c56f7 598BEGIN_FW_FTR_SECTION
d04c56f7
PM
599 stb r7,PACAHARDIRQEN(r13)
600END_FW_FTR_SECTION_IFCLR(FW_FEATURE_ISERIES)
ff3da2e0 601 stb r7,PACASOFTIRQEN(r13)
d04c56f7 602
b5bbeb23
PM
603 mtspr SPRN_SRR0,r3
604 mtspr SPRN_SRR1,r4
2d27cfd3 605 RFI
14cf11af
PM
606 b . /* prevent speculative execution */
607
608/*
609 * Running with relocation on at this point. All we want to do is
e31aa453
PM
610 * zero the stack back-chain pointer and get the TOC virtual address
611 * before going into C code.
14cf11af
PM
612 */
613_GLOBAL(start_secondary_prolog)
e31aa453 614 ld r2,PACATOC(r13)
14cf11af
PM
615 li r3,0
616 std r3,0(r1) /* Zero the stack frame pointer */
617 bl .start_secondary
799d6046 618 b .
8dbce53c
VS
619/*
620 * Reset stack pointer and call start_secondary
621 * to continue with online operation when woken up
622 * from cede in cpu offline.
623 */
624_GLOBAL(start_secondary_resume)
625 ld r1,PACAKSAVE(r13) /* Reload kernel stack pointer */
626 li r3,0
627 std r3,0(r1) /* Zero the stack frame pointer */
628 bl .start_secondary
629 b .
14cf11af
PM
630#endif
631
632/*
633 * This subroutine clobbers r11 and r12
634 */
635_GLOBAL(enable_64b_mode)
636 mfmsr r11 /* grab the current MSR */
2d27cfd3
BH
637#ifdef CONFIG_PPC_BOOK3E
638 oris r11,r11,0x8000 /* CM bit set, we'll set ICM later */
639 mtmsr r11
640#else /* CONFIG_PPC_BOOK3E */
e31aa453
PM
641 li r12,(MSR_SF | MSR_ISF)@highest
642 sldi r12,r12,48
14cf11af
PM
643 or r11,r11,r12
644 mtmsrd r11
645 isync
2d27cfd3 646#endif
14cf11af
PM
647 blr
648
e31aa453
PM
649/*
650 * This puts the TOC pointer into r2, offset by 0x8000 (as expected
651 * by the toolchain). It computes the correct value for wherever we
652 * are running at the moment, using position-independent code.
653 */
654_GLOBAL(relative_toc)
655 mflr r0
656 bcl 20,31,$+4
6570: mflr r9
658 ld r2,(p_toc - 0b)(r9)
659 add r2,r2,r9
660 mtlr r0
661 blr
662
663p_toc: .llong __toc_start + 0x8000 - 0b
664
14cf11af
PM
665/*
666 * This is where the main kernel code starts.
667 */
939e60f6 668_INIT_STATIC(start_here_multiplatform)
e31aa453
PM
669 /* set up the TOC (real address) */
670 bl .relative_toc
14cf11af
PM
671
672 /* Clear out the BSS. It may have been done in prom_init,
673 * already but that's irrelevant since prom_init will soon
674 * be detached from the kernel completely. Besides, we need
675 * to clear it now for kexec-style entry.
676 */
e31aa453
PM
677 LOAD_REG_ADDR(r11,__bss_stop)
678 LOAD_REG_ADDR(r8,__bss_start)
14cf11af
PM
679 sub r11,r11,r8 /* bss size */
680 addi r11,r11,7 /* round up to an even double word */
e31aa453 681 srdi. r11,r11,3 /* shift right by 3 */
14cf11af
PM
682 beq 4f
683 addi r8,r8,-8
684 li r0,0
685 mtctr r11 /* zero this many doublewords */
6863: stdu r0,8(r8)
687 bdnz 3b
6884:
689
2d27cfd3 690#ifndef CONFIG_PPC_BOOK3E
14cf11af
PM
691 mfmsr r6
692 ori r6,r6,MSR_RI
693 mtmsrd r6 /* RI on */
2d27cfd3 694#endif
14cf11af 695
549e8152
PM
696#ifdef CONFIG_RELOCATABLE
697 /* Save the physical address we're running at in kernstart_addr */
698 LOAD_REG_ADDR(r4, kernstart_addr)
699 clrldi r0,r25,2
700 std r0,0(r4)
701#endif
702
e31aa453 703 /* The following gets the stack set up with the regs */
14cf11af
PM
704 /* pointing to the real addr of the kernel stack. This is */
705 /* all done to support the C function call below which sets */
706 /* up the htab. This is done because we have relocated the */
707 /* kernel but are still running in real mode. */
708
e31aa453 709 LOAD_REG_ADDR(r3,init_thread_union)
14cf11af 710
e31aa453 711 /* set up a stack pointer */
14cf11af
PM
712 addi r1,r3,THREAD_SIZE
713 li r0,0
714 stdu r0,-STACK_FRAME_OVERHEAD(r1)
715
14cf11af
PM
716 /* Do very early kernel initializations, including initial hash table,
717 * stab and slb setup before we turn on relocation. */
718
719 /* Restore parameters passed from prom_init/kexec */
720 mr r3,r31
ee43eb78 721 bl .early_setup /* also sets r13 and SPRG_PACA */
14cf11af 722
e31aa453
PM
723 LOAD_REG_ADDR(r3, .start_here_common)
724 ld r4,PACAKMSR(r13)
b5bbeb23
PM
725 mtspr SPRN_SRR0,r3
726 mtspr SPRN_SRR1,r4
2d27cfd3 727 RFI
14cf11af 728 b . /* prevent speculative execution */
14cf11af
PM
729
730 /* This is where all platforms converge execution */
fc68e869 731_INIT_GLOBAL(start_here_common)
14cf11af 732 /* relocation is on at this point */
e31aa453 733 std r1,PACAKSAVE(r13)
14cf11af 734
e31aa453 735 /* Load the TOC (virtual address) */
14cf11af 736 ld r2,PACATOC(r13)
14cf11af
PM
737
738 bl .setup_system
739
740 /* Load up the kernel context */
7415:
14cf11af 742 li r5,0
d04c56f7
PM
743 stb r5,PACASOFTIRQEN(r13) /* Soft Disabled */
744#ifdef CONFIG_PPC_ISERIES
745BEGIN_FW_FTR_SECTION
14cf11af 746 mfmsr r5
ff3da2e0 747 ori r5,r5,MSR_EE /* Hard Enabled on iSeries*/
14cf11af 748 mtmsrd r5
ff3da2e0 749 li r5,1
3f639ee8 750END_FW_FTR_SECTION_IFSET(FW_FEATURE_ISERIES)
14cf11af 751#endif
ff3da2e0 752 stb r5,PACAHARDIRQEN(r13) /* Hard Disabled on others */
14cf11af 753
ff3da2e0 754 bl .start_kernel
14cf11af 755
f1870f77
AB
756 /* Not reached */
757 BUG_OPCODE
14cf11af 758
14cf11af
PM
759/*
760 * We put a few things here that have to be page-aligned.
761 * This stuff goes at the beginning of the bss, which is page-aligned.
762 */
763 .section ".bss"
764
765 .align PAGE_SHIFT
766
767 .globl empty_zero_page
768empty_zero_page:
769 .space PAGE_SIZE
770
771 .globl swapper_pg_dir
772swapper_pg_dir:
ee7a76da 773 .space PGD_TABLE_SIZE