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