114cf11afSPaul Mackerras/* 214cf11afSPaul Mackerras * PowerPC version 314cf11afSPaul Mackerras * Copyright (C) 1995-1996 Gary Thomas (gdt@linuxppc.org) 414cf11afSPaul Mackerras * 514cf11afSPaul Mackerras * Rewritten by Cort Dougan (cort@cs.nmt.edu) for PReP 614cf11afSPaul Mackerras * Copyright (C) 1996 Cort Dougan <cort@cs.nmt.edu> 714cf11afSPaul Mackerras * Adapted for Power Macintosh by Paul Mackerras. 814cf11afSPaul Mackerras * Low-level exception handlers and MMU support 914cf11afSPaul Mackerras * rewritten by Paul Mackerras. 1014cf11afSPaul Mackerras * Copyright (C) 1996 Paul Mackerras. 1114cf11afSPaul Mackerras * 1214cf11afSPaul Mackerras * Adapted for 64bit PowerPC by Dave Engebretsen, Peter Bergner, and 1314cf11afSPaul Mackerras * Mike Corrigan {engebret|bergner|mikejc}@us.ibm.com 1414cf11afSPaul Mackerras * 150ebc4cdaSBenjamin Herrenschmidt * This file contains the entry point for the 64-bit kernel along 160ebc4cdaSBenjamin Herrenschmidt * with some early initialization code common to all 64-bit powerpc 170ebc4cdaSBenjamin Herrenschmidt * variants. 1814cf11afSPaul Mackerras * 1914cf11afSPaul Mackerras * This program is free software; you can redistribute it and/or 2014cf11afSPaul Mackerras * modify it under the terms of the GNU General Public License 2114cf11afSPaul Mackerras * as published by the Free Software Foundation; either version 2214cf11afSPaul Mackerras * 2 of the License, or (at your option) any later version. 2314cf11afSPaul Mackerras */ 2414cf11afSPaul Mackerras 2514cf11afSPaul Mackerras#include <linux/threads.h> 26b5bbeb23SPaul Mackerras#include <asm/reg.h> 2714cf11afSPaul Mackerras#include <asm/page.h> 2814cf11afSPaul Mackerras#include <asm/mmu.h> 2914cf11afSPaul Mackerras#include <asm/ppc_asm.h> 3014cf11afSPaul Mackerras#include <asm/asm-offsets.h> 3114cf11afSPaul Mackerras#include <asm/bug.h> 3214cf11afSPaul Mackerras#include <asm/cputable.h> 3314cf11afSPaul Mackerras#include <asm/setup.h> 3414cf11afSPaul Mackerras#include <asm/hvcall.h> 356cb7bfebSDavid Gibson#include <asm/thread_info.h> 363f639ee8SStephen Rothwell#include <asm/firmware.h> 3716a15a30SStephen Rothwell#include <asm/page_64.h> 38945feb17SBenjamin Herrenschmidt#include <asm/irqflags.h> 392191d657SAlexander Graf#include <asm/kvm_book3s_asm.h> 4046f52210SStephen Rothwell#include <asm/ptrace.h> 417230c564SBenjamin Herrenschmidt#include <asm/hw_irq.h> 4214cf11afSPaul Mackerras 4325985edcSLucas De Marchi/* The physical memory is laid out such that the secondary processor 440ebc4cdaSBenjamin Herrenschmidt * spin code sits at 0x0000...0x00ff. On server, the vectors follow 450ebc4cdaSBenjamin Herrenschmidt * using the layout described in exceptions-64s.S 4614cf11afSPaul Mackerras */ 4714cf11afSPaul Mackerras 4814cf11afSPaul Mackerras/* 4914cf11afSPaul Mackerras * Entering into this code we make the following assumptions: 500ebc4cdaSBenjamin Herrenschmidt * 510ebc4cdaSBenjamin Herrenschmidt * For pSeries or server processors: 5214cf11afSPaul Mackerras * 1. The MMU is off & open firmware is running in real mode. 5314cf11afSPaul Mackerras * 2. The kernel is entered at __start 5427f44888SBenjamin Herrenschmidt * -or- For OPAL entry: 5527f44888SBenjamin Herrenschmidt * 1. The MMU is off, processor in HV mode, primary CPU enters at 0 56daea1175SBenjamin Herrenschmidt * with device-tree in gpr3. We also get OPAL base in r8 and 57daea1175SBenjamin Herrenschmidt * entry in r9 for debugging purposes 5827f44888SBenjamin Herrenschmidt * 2. Secondary processors enter at 0x60 with PIR in gpr3 5914cf11afSPaul Mackerras * 600ebc4cdaSBenjamin Herrenschmidt * For Book3E processors: 610ebc4cdaSBenjamin Herrenschmidt * 1. The MMU is on running in AS0 in a state defined in ePAPR 620ebc4cdaSBenjamin Herrenschmidt * 2. The kernel is entered at __start 6314cf11afSPaul Mackerras */ 6414cf11afSPaul Mackerras 6514cf11afSPaul Mackerras .text 6614cf11afSPaul Mackerras .globl _stext 6714cf11afSPaul Mackerras_stext: 6814cf11afSPaul Mackerras_GLOBAL(__start) 6914cf11afSPaul Mackerras /* NOP this out unconditionally */ 7014cf11afSPaul MackerrasBEGIN_FTR_SECTION 71*5c0484e2SBenjamin Herrenschmidt FIXUP_ENDIAN 7214cf11afSPaul Mackerras b .__start_initialization_multiplatform 7314cf11afSPaul MackerrasEND_FTR_SECTION(0, 1) 7414cf11afSPaul Mackerras 7514cf11afSPaul Mackerras /* Catch branch to 0 in real mode */ 7614cf11afSPaul Mackerras trap 7714cf11afSPaul Mackerras 781f6a93e4SPaul Mackerras /* Secondary processors spin on this value until it becomes nonzero. 791f6a93e4SPaul Mackerras * When it does it contains the real address of the descriptor 801f6a93e4SPaul Mackerras * of the function that the cpu should jump to to continue 811f6a93e4SPaul Mackerras * initialization. 821f6a93e4SPaul Mackerras */ 8314cf11afSPaul Mackerras .globl __secondary_hold_spinloop 8414cf11afSPaul Mackerras__secondary_hold_spinloop: 8514cf11afSPaul Mackerras .llong 0x0 8614cf11afSPaul Mackerras 8714cf11afSPaul Mackerras /* Secondary processors write this value with their cpu # */ 8814cf11afSPaul Mackerras /* after they enter the spin loop immediately below. */ 8914cf11afSPaul Mackerras .globl __secondary_hold_acknowledge 9014cf11afSPaul Mackerras__secondary_hold_acknowledge: 9114cf11afSPaul Mackerras .llong 0x0 9214cf11afSPaul Mackerras 93928a3197SSonny Rao#ifdef CONFIG_RELOCATABLE 948b8b0cc1SMilton Miller /* This flag is set to 1 by a loader if the kernel should run 958b8b0cc1SMilton Miller * at the loaded address instead of the linked address. This 968b8b0cc1SMilton Miller * is used by kexec-tools to keep the the kdump kernel in the 978b8b0cc1SMilton Miller * crash_kernel region. The loader is responsible for 988b8b0cc1SMilton Miller * observing the alignment requirement. 998b8b0cc1SMilton Miller */ 1008b8b0cc1SMilton Miller /* Do not move this variable as kexec-tools knows about it. */ 1018b8b0cc1SMilton Miller . = 0x5c 1028b8b0cc1SMilton Miller .globl __run_at_load 1038b8b0cc1SMilton Miller__run_at_load: 1048b8b0cc1SMilton Miller .long 0x72756e30 /* "run0" -- relocate to 0 by default */ 1058b8b0cc1SMilton Miller#endif 1068b8b0cc1SMilton Miller 10714cf11afSPaul Mackerras . = 0x60 10814cf11afSPaul Mackerras/* 10975423b7bSGeoff Levand * The following code is used to hold secondary processors 11075423b7bSGeoff Levand * in a spin loop after they have entered the kernel, but 11114cf11afSPaul Mackerras * before the bulk of the kernel has been relocated. This code 11214cf11afSPaul Mackerras * is relocated to physical address 0x60 before prom_init is run. 11314cf11afSPaul Mackerras * All of it must fit below the first exception vector at 0x100. 1141f6a93e4SPaul Mackerras * Use .globl here not _GLOBAL because we want __secondary_hold 1151f6a93e4SPaul Mackerras * to be the actual text address, not a descriptor. 11614cf11afSPaul Mackerras */ 1171f6a93e4SPaul Mackerras .globl __secondary_hold 1181f6a93e4SPaul Mackerras__secondary_hold: 119*5c0484e2SBenjamin Herrenschmidt FIXUP_ENDIAN 1202d27cfd3SBenjamin Herrenschmidt#ifndef CONFIG_PPC_BOOK3E 12114cf11afSPaul Mackerras mfmsr r24 12214cf11afSPaul Mackerras ori r24,r24,MSR_RI 12314cf11afSPaul Mackerras mtmsrd r24 /* RI on */ 1242d27cfd3SBenjamin Herrenschmidt#endif 125f1870f77SAnton Blanchard /* Grab our physical cpu number */ 12614cf11afSPaul Mackerras mr r24,r3 12796f013feSJimi Xenidis /* stash r4 for book3e */ 12896f013feSJimi Xenidis mr r25,r4 12914cf11afSPaul Mackerras 13014cf11afSPaul Mackerras /* Tell the master cpu we're here */ 13114cf11afSPaul Mackerras /* Relocation is off & we are located at an address less */ 13214cf11afSPaul Mackerras /* than 0x100, so only need to grab low order offset. */ 133e31aa453SPaul Mackerras std r24,__secondary_hold_acknowledge-_stext(0) 13414cf11afSPaul Mackerras sync 13514cf11afSPaul Mackerras 13696f013feSJimi Xenidis li r26,0 13796f013feSJimi Xenidis#ifdef CONFIG_PPC_BOOK3E 13896f013feSJimi Xenidis tovirt(r26,r26) 13996f013feSJimi Xenidis#endif 14014cf11afSPaul Mackerras /* All secondary cpus wait here until told to start. */ 14196f013feSJimi Xenidis100: ld r4,__secondary_hold_spinloop-_stext(r26) 1421f6a93e4SPaul Mackerras cmpdi 0,r4,0 1431f6a93e4SPaul Mackerras beq 100b 14414cf11afSPaul Mackerras 145f1870f77SAnton Blanchard#if defined(CONFIG_SMP) || defined(CONFIG_KEXEC) 14696f013feSJimi Xenidis#ifdef CONFIG_PPC_BOOK3E 14796f013feSJimi Xenidis tovirt(r4,r4) 14896f013feSJimi Xenidis#endif 1491f6a93e4SPaul Mackerras ld r4,0(r4) /* deref function descriptor */ 150758438a7SMichael Ellerman mtctr r4 15114cf11afSPaul Mackerras mr r3,r24 15296f013feSJimi Xenidis /* 15396f013feSJimi Xenidis * it may be the case that other platforms have r4 right to 15496f013feSJimi Xenidis * begin with, this gives us some safety in case it is not 15596f013feSJimi Xenidis */ 15696f013feSJimi Xenidis#ifdef CONFIG_PPC_BOOK3E 15796f013feSJimi Xenidis mr r4,r25 15896f013feSJimi Xenidis#else 1592d27cfd3SBenjamin Herrenschmidt li r4,0 16096f013feSJimi Xenidis#endif 161dd797738SBenjamin Herrenschmidt /* Make sure that patched code is visible */ 162dd797738SBenjamin Herrenschmidt isync 163758438a7SMichael Ellerman bctr 16414cf11afSPaul Mackerras#else 16514cf11afSPaul Mackerras BUG_OPCODE 16614cf11afSPaul Mackerras#endif 16714cf11afSPaul Mackerras 16814cf11afSPaul Mackerras/* This value is used to mark exception frames on the stack. */ 16914cf11afSPaul Mackerras .section ".toc","aw" 17014cf11afSPaul Mackerrasexception_marker: 17114cf11afSPaul Mackerras .tc ID_72656773_68657265[TC],0x7265677368657265 17214cf11afSPaul Mackerras .text 17314cf11afSPaul Mackerras 17414cf11afSPaul Mackerras/* 1750ebc4cdaSBenjamin Herrenschmidt * On server, we include the exception vectors code here as it 1760ebc4cdaSBenjamin Herrenschmidt * relies on absolute addressing which is only possible within 1770ebc4cdaSBenjamin Herrenschmidt * this compilation unit 17814cf11afSPaul Mackerras */ 1790ebc4cdaSBenjamin Herrenschmidt#ifdef CONFIG_PPC_BOOK3S 1800ebc4cdaSBenjamin Herrenschmidt#include "exceptions-64s.S" 1811f6a93e4SPaul Mackerras#endif 18214cf11afSPaul Mackerras 1832d27cfd3SBenjamin Herrenschmidt_GLOBAL(generic_secondary_thread_init) 18414cf11afSPaul Mackerras mr r24,r3 18514cf11afSPaul Mackerras 18614cf11afSPaul Mackerras /* turn on 64-bit mode */ 18714cf11afSPaul Mackerras bl .enable_64b_mode 18814cf11afSPaul Mackerras 1892d27cfd3SBenjamin Herrenschmidt /* get a valid TOC pointer, wherever we're mapped at */ 190e31aa453SPaul Mackerras bl .relative_toc 1911fbe9cf2SAnton Blanchard tovirt(r2,r2) 192e31aa453SPaul Mackerras 1932d27cfd3SBenjamin Herrenschmidt#ifdef CONFIG_PPC_BOOK3E 1942d27cfd3SBenjamin Herrenschmidt /* Book3E initialization */ 1952d27cfd3SBenjamin Herrenschmidt mr r3,r24 1962d27cfd3SBenjamin Herrenschmidt bl .book3e_secondary_thread_init 1972d27cfd3SBenjamin Herrenschmidt#endif 1982d27cfd3SBenjamin Herrenschmidt b generic_secondary_common_init 1992d27cfd3SBenjamin Herrenschmidt 2002d27cfd3SBenjamin Herrenschmidt/* 2012d27cfd3SBenjamin Herrenschmidt * On pSeries and most other platforms, secondary processors spin 2022d27cfd3SBenjamin Herrenschmidt * in the following code. 2032d27cfd3SBenjamin Herrenschmidt * At entry, r3 = this processor's number (physical cpu id) 2042d27cfd3SBenjamin Herrenschmidt * 2052d27cfd3SBenjamin Herrenschmidt * On Book3E, r4 = 1 to indicate that the initial TLB entry for 2062d27cfd3SBenjamin Herrenschmidt * this core already exists (setup via some other mechanism such 2072d27cfd3SBenjamin Herrenschmidt * as SCOM before entry). 2082d27cfd3SBenjamin Herrenschmidt */ 2092d27cfd3SBenjamin Herrenschmidt_GLOBAL(generic_secondary_smp_init) 210*5c0484e2SBenjamin Herrenschmidt FIXUP_ENDIAN 2112d27cfd3SBenjamin Herrenschmidt mr r24,r3 2122d27cfd3SBenjamin Herrenschmidt mr r25,r4 2132d27cfd3SBenjamin Herrenschmidt 2142d27cfd3SBenjamin Herrenschmidt /* turn on 64-bit mode */ 2152d27cfd3SBenjamin Herrenschmidt bl .enable_64b_mode 2162d27cfd3SBenjamin Herrenschmidt 2172d27cfd3SBenjamin Herrenschmidt /* get a valid TOC pointer, wherever we're mapped at */ 2182d27cfd3SBenjamin Herrenschmidt bl .relative_toc 2191fbe9cf2SAnton Blanchard tovirt(r2,r2) 2202d27cfd3SBenjamin Herrenschmidt 2212d27cfd3SBenjamin Herrenschmidt#ifdef CONFIG_PPC_BOOK3E 2222d27cfd3SBenjamin Herrenschmidt /* Book3E initialization */ 2232d27cfd3SBenjamin Herrenschmidt mr r3,r24 2242d27cfd3SBenjamin Herrenschmidt mr r4,r25 2252d27cfd3SBenjamin Herrenschmidt bl .book3e_secondary_core_init 2262d27cfd3SBenjamin Herrenschmidt#endif 2272d27cfd3SBenjamin Herrenschmidt 2282d27cfd3SBenjamin Herrenschmidtgeneric_secondary_common_init: 22914cf11afSPaul Mackerras /* Set up a paca value for this processor. Since we have the 23014cf11afSPaul Mackerras * physical cpu id in r24, we need to search the pacas to find 23114cf11afSPaul Mackerras * which logical id maps to our physical one. 23214cf11afSPaul Mackerras */ 2331426d5a3SMichael Ellerman LOAD_REG_ADDR(r13, paca) /* Load paca pointer */ 2341426d5a3SMichael Ellerman ld r13,0(r13) /* Get base vaddr of paca array */ 235768d18adSMilton Miller#ifndef CONFIG_SMP 236768d18adSMilton Miller addi r13,r13,PACA_SIZE /* know r13 if used accidentally */ 237768d18adSMilton Miller b .kexec_wait /* wait for next kernel if !SMP */ 238768d18adSMilton Miller#else 239768d18adSMilton Miller LOAD_REG_ADDR(r7, nr_cpu_ids) /* Load nr_cpu_ids address */ 240768d18adSMilton Miller lwz r7,0(r7) /* also the max paca allocated */ 24114cf11afSPaul Mackerras li r5,0 /* logical cpu id */ 24214cf11afSPaul Mackerras1: lhz r6,PACAHWCPUID(r13) /* Load HW procid from paca */ 24314cf11afSPaul Mackerras cmpw r6,r24 /* Compare to our id */ 24414cf11afSPaul Mackerras beq 2f 24514cf11afSPaul Mackerras addi r13,r13,PACA_SIZE /* Loop to next PACA on miss */ 24614cf11afSPaul Mackerras addi r5,r5,1 247768d18adSMilton Miller cmpw r5,r7 /* Check if more pacas exist */ 24814cf11afSPaul Mackerras blt 1b 24914cf11afSPaul Mackerras 25014cf11afSPaul Mackerras mr r3,r24 /* not found, copy phys to r3 */ 25114cf11afSPaul Mackerras b .kexec_wait /* next kernel might do better */ 25214cf11afSPaul Mackerras 2532dd60d79SBenjamin Herrenschmidt2: SET_PACA(r13) 2542d27cfd3SBenjamin Herrenschmidt#ifdef CONFIG_PPC_BOOK3E 2552d27cfd3SBenjamin Herrenschmidt addi r12,r13,PACA_EXTLB /* and TLB exc frame in another */ 2562d27cfd3SBenjamin Herrenschmidt mtspr SPRN_SPRG_TLB_EXFRAME,r12 2572d27cfd3SBenjamin Herrenschmidt#endif 2582d27cfd3SBenjamin Herrenschmidt 25914cf11afSPaul Mackerras /* From now on, r24 is expected to be logical cpuid */ 26014cf11afSPaul Mackerras mr r24,r5 261b6f6b98aSSonny Rao 262f39b7a55SOlof Johansson /* See if we need to call a cpu state restore handler */ 263e31aa453SPaul Mackerras LOAD_REG_ADDR(r23, cur_cpu_spec) 264f39b7a55SOlof Johansson ld r23,0(r23) 265f39b7a55SOlof Johansson ld r23,CPU_SPEC_RESTORE(r23) 266f39b7a55SOlof Johansson cmpdi 0,r23,0 2679d07bc84SBenjamin Herrenschmidt beq 3f 268f39b7a55SOlof Johansson ld r23,0(r23) 269f39b7a55SOlof Johansson mtctr r23 270f39b7a55SOlof Johansson bctrl 271f39b7a55SOlof Johansson 2727ac87abbSMatt Evans3: LOAD_REG_ADDR(r3, spinning_secondaries) /* Decrement spinning_secondaries */ 2739d07bc84SBenjamin Herrenschmidt lwarx r4,0,r3 2749d07bc84SBenjamin Herrenschmidt subi r4,r4,1 2759d07bc84SBenjamin Herrenschmidt stwcx. r4,0,r3 2769d07bc84SBenjamin Herrenschmidt bne 3b 2779d07bc84SBenjamin Herrenschmidt isync 2789d07bc84SBenjamin Herrenschmidt 2799d07bc84SBenjamin Herrenschmidt4: HMT_LOW 280ad0693eeSBenjamin Herrenschmidt lbz r23,PACAPROCSTART(r13) /* Test if this processor should */ 281ad0693eeSBenjamin Herrenschmidt /* start. */ 282ad0693eeSBenjamin Herrenschmidt cmpwi 0,r23,0 2839d07bc84SBenjamin Herrenschmidt beq 4b /* Loop until told to go */ 284ad0693eeSBenjamin Herrenschmidt 285ad0693eeSBenjamin Herrenschmidt sync /* order paca.run and cur_cpu_spec */ 2869d07bc84SBenjamin Herrenschmidt isync /* In case code patching happened */ 287ad0693eeSBenjamin Herrenschmidt 2889d07bc84SBenjamin Herrenschmidt /* Create a temp kernel stack for use before relocation is on. */ 28914cf11afSPaul Mackerras ld r1,PACAEMERGSP(r13) 29014cf11afSPaul Mackerras subi r1,r1,STACK_FRAME_OVERHEAD 29114cf11afSPaul Mackerras 292c705677eSStephen Rothwell b __secondary_start 293768d18adSMilton Miller#endif /* SMP */ 29414cf11afSPaul Mackerras 295e31aa453SPaul Mackerras/* 296e31aa453SPaul Mackerras * Turn the MMU off. 297e31aa453SPaul Mackerras * Assumes we're mapped EA == RA if the MMU is on. 298e31aa453SPaul Mackerras */ 2992d27cfd3SBenjamin Herrenschmidt#ifdef CONFIG_PPC_BOOK3S 30014cf11afSPaul Mackerras_STATIC(__mmu_off) 30114cf11afSPaul Mackerras mfmsr r3 30214cf11afSPaul Mackerras andi. r0,r3,MSR_IR|MSR_DR 30314cf11afSPaul Mackerras beqlr 304e31aa453SPaul Mackerras mflr r4 30514cf11afSPaul Mackerras andc r3,r3,r0 30614cf11afSPaul Mackerras mtspr SPRN_SRR0,r4 30714cf11afSPaul Mackerras mtspr SPRN_SRR1,r3 30814cf11afSPaul Mackerras sync 30914cf11afSPaul Mackerras rfid 31014cf11afSPaul Mackerras b . /* prevent speculative execution */ 3112d27cfd3SBenjamin Herrenschmidt#endif 31214cf11afSPaul Mackerras 31314cf11afSPaul Mackerras 31414cf11afSPaul Mackerras/* 31514cf11afSPaul Mackerras * Here is our main kernel entry point. We support currently 2 kind of entries 31614cf11afSPaul Mackerras * depending on the value of r5. 31714cf11afSPaul Mackerras * 31814cf11afSPaul Mackerras * r5 != NULL -> OF entry, we go to prom_init, "legacy" parameter content 31914cf11afSPaul Mackerras * in r3...r7 32014cf11afSPaul Mackerras * 32114cf11afSPaul Mackerras * r5 == NULL -> kexec style entry. r3 is a physical pointer to the 32214cf11afSPaul Mackerras * DT block, r4 is a physical pointer to the kernel itself 32314cf11afSPaul Mackerras * 32414cf11afSPaul Mackerras */ 32514cf11afSPaul Mackerras_GLOBAL(__start_initialization_multiplatform) 326e31aa453SPaul Mackerras /* Make sure we are running in 64 bits mode */ 327e31aa453SPaul Mackerras bl .enable_64b_mode 328e31aa453SPaul Mackerras 329e31aa453SPaul Mackerras /* Get TOC pointer (current runtime address) */ 330e31aa453SPaul Mackerras bl .relative_toc 331e31aa453SPaul Mackerras 332e31aa453SPaul Mackerras /* find out where we are now */ 333e31aa453SPaul Mackerras bcl 20,31,$+4 334e31aa453SPaul Mackerras0: mflr r26 /* r26 = runtime addr here */ 335e31aa453SPaul Mackerras addis r26,r26,(_stext - 0b)@ha 336e31aa453SPaul Mackerras addi r26,r26,(_stext - 0b)@l /* current runtime base addr */ 337e31aa453SPaul Mackerras 33814cf11afSPaul Mackerras /* 33914cf11afSPaul Mackerras * Are we booted from a PROM Of-type client-interface ? 34014cf11afSPaul Mackerras */ 34114cf11afSPaul Mackerras cmpldi cr0,r5,0 342939e60f6SStephen Rothwell beq 1f 343939e60f6SStephen Rothwell b .__boot_from_prom /* yes -> prom */ 344939e60f6SStephen Rothwell1: 34514cf11afSPaul Mackerras /* Save parameters */ 34614cf11afSPaul Mackerras mr r31,r3 34714cf11afSPaul Mackerras mr r30,r4 348daea1175SBenjamin Herrenschmidt#ifdef CONFIG_PPC_EARLY_DEBUG_OPAL 349daea1175SBenjamin Herrenschmidt /* Save OPAL entry */ 350daea1175SBenjamin Herrenschmidt mr r28,r8 351daea1175SBenjamin Herrenschmidt mr r29,r9 352daea1175SBenjamin Herrenschmidt#endif 35314cf11afSPaul Mackerras 3542d27cfd3SBenjamin Herrenschmidt#ifdef CONFIG_PPC_BOOK3E 3552d27cfd3SBenjamin Herrenschmidt bl .start_initialization_book3e 3562d27cfd3SBenjamin Herrenschmidt b .__after_prom_start 3572d27cfd3SBenjamin Herrenschmidt#else 35814cf11afSPaul Mackerras /* Setup some critical 970 SPRs before switching MMU off */ 359f39b7a55SOlof Johansson mfspr r0,SPRN_PVR 360f39b7a55SOlof Johansson srwi r0,r0,16 361f39b7a55SOlof Johansson cmpwi r0,0x39 /* 970 */ 362f39b7a55SOlof Johansson beq 1f 363f39b7a55SOlof Johansson cmpwi r0,0x3c /* 970FX */ 364f39b7a55SOlof Johansson beq 1f 365f39b7a55SOlof Johansson cmpwi r0,0x44 /* 970MP */ 366190a24f5SOlof Johansson beq 1f 367190a24f5SOlof Johansson cmpwi r0,0x45 /* 970GX */ 368f39b7a55SOlof Johansson bne 2f 369f39b7a55SOlof Johansson1: bl .__cpu_preinit_ppc970 370f39b7a55SOlof Johansson2: 37114cf11afSPaul Mackerras 372e31aa453SPaul Mackerras /* Switch off MMU if not already off */ 37314cf11afSPaul Mackerras bl .__mmu_off 37414cf11afSPaul Mackerras b .__after_prom_start 3752d27cfd3SBenjamin Herrenschmidt#endif /* CONFIG_PPC_BOOK3E */ 37614cf11afSPaul Mackerras 377939e60f6SStephen Rothwell_INIT_STATIC(__boot_from_prom) 37828794d34SBenjamin Herrenschmidt#ifdef CONFIG_PPC_OF_BOOT_TRAMPOLINE 37914cf11afSPaul Mackerras /* Save parameters */ 38014cf11afSPaul Mackerras mr r31,r3 38114cf11afSPaul Mackerras mr r30,r4 38214cf11afSPaul Mackerras mr r29,r5 38314cf11afSPaul Mackerras mr r28,r6 38414cf11afSPaul Mackerras mr r27,r7 38514cf11afSPaul Mackerras 3866088857bSOlaf Hering /* 3876088857bSOlaf Hering * Align the stack to 16-byte boundary 3886088857bSOlaf Hering * Depending on the size and layout of the ELF sections in the initial 389e31aa453SPaul Mackerras * boot binary, the stack pointer may be unaligned on PowerMac 3906088857bSOlaf Hering */ 391c05b4770SLinus Torvalds rldicr r1,r1,0,59 392c05b4770SLinus Torvalds 393549e8152SPaul Mackerras#ifdef CONFIG_RELOCATABLE 394549e8152SPaul Mackerras /* Relocate code for where we are now */ 395549e8152SPaul Mackerras mr r3,r26 396549e8152SPaul Mackerras bl .relocate 397549e8152SPaul Mackerras#endif 398549e8152SPaul Mackerras 39914cf11afSPaul Mackerras /* Restore parameters */ 40014cf11afSPaul Mackerras mr r3,r31 40114cf11afSPaul Mackerras mr r4,r30 40214cf11afSPaul Mackerras mr r5,r29 40314cf11afSPaul Mackerras mr r6,r28 40414cf11afSPaul Mackerras mr r7,r27 40514cf11afSPaul Mackerras 40614cf11afSPaul Mackerras /* Do all of the interaction with OF client interface */ 407549e8152SPaul Mackerras mr r8,r26 40814cf11afSPaul Mackerras bl .prom_init 40928794d34SBenjamin Herrenschmidt#endif /* #CONFIG_PPC_OF_BOOT_TRAMPOLINE */ 41028794d34SBenjamin Herrenschmidt 41128794d34SBenjamin Herrenschmidt /* We never return. We also hit that trap if trying to boot 41228794d34SBenjamin Herrenschmidt * from OF while CONFIG_PPC_OF_BOOT_TRAMPOLINE isn't selected */ 41314cf11afSPaul Mackerras trap 41414cf11afSPaul Mackerras 41514cf11afSPaul Mackerras_STATIC(__after_prom_start) 416549e8152SPaul Mackerras#ifdef CONFIG_RELOCATABLE 417549e8152SPaul Mackerras /* process relocations for the final address of the kernel */ 418549e8152SPaul Mackerras lis r25,PAGE_OFFSET@highest /* compute virtual base of kernel */ 419549e8152SPaul Mackerras sldi r25,r25,32 4208b8b0cc1SMilton Miller lwz r7,__run_at_load-_stext(r26) 421928a3197SSonny Rao cmplwi cr0,r7,1 /* flagged to stay where we are ? */ 42254622f10SMohan Kumar M bne 1f 42354622f10SMohan Kumar M add r25,r25,r26 42454622f10SMohan Kumar M1: mr r3,r25 425549e8152SPaul Mackerras bl .relocate 426549e8152SPaul Mackerras#endif 42714cf11afSPaul Mackerras 42814cf11afSPaul Mackerras/* 429e31aa453SPaul Mackerras * We need to run with _stext at physical address PHYSICAL_START. 43014cf11afSPaul Mackerras * This will leave some code in the first 256B of 43114cf11afSPaul Mackerras * real memory, which are reserved for software use. 43214cf11afSPaul Mackerras * 43314cf11afSPaul Mackerras * Note: This process overwrites the OF exception vectors. 43414cf11afSPaul Mackerras */ 435549e8152SPaul Mackerras li r3,0 /* target addr */ 4362d27cfd3SBenjamin Herrenschmidt#ifdef CONFIG_PPC_BOOK3E 4372d27cfd3SBenjamin Herrenschmidt tovirt(r3,r3) /* on booke, we already run at PAGE_OFFSET */ 4382d27cfd3SBenjamin Herrenschmidt#endif 439549e8152SPaul Mackerras mr. r4,r26 /* In some cases the loader may */ 440e31aa453SPaul Mackerras beq 9f /* have already put us at zero */ 44114cf11afSPaul Mackerras li r6,0x100 /* Start offset, the first 0x100 */ 44214cf11afSPaul Mackerras /* bytes were copied earlier. */ 4432d27cfd3SBenjamin Herrenschmidt#ifdef CONFIG_PPC_BOOK3E 4442d27cfd3SBenjamin Herrenschmidt tovirt(r6,r6) /* on booke, we already run at PAGE_OFFSET */ 4452d27cfd3SBenjamin Herrenschmidt#endif 44614cf11afSPaul Mackerras 44711ee7e99SAnton Blanchard#ifdef CONFIG_RELOCATABLE 44854622f10SMohan Kumar M/* 44954622f10SMohan Kumar M * Check if the kernel has to be running as relocatable kernel based on the 4508b8b0cc1SMilton Miller * variable __run_at_load, if it is set the kernel is treated as relocatable 45154622f10SMohan Kumar M * kernel, otherwise it will be moved to PHYSICAL_START 45254622f10SMohan Kumar M */ 4538b8b0cc1SMilton Miller lwz r7,__run_at_load-_stext(r26) 4548b8b0cc1SMilton Miller cmplwi cr0,r7,1 45554622f10SMohan Kumar M bne 3f 45654622f10SMohan Kumar M 457c1fb6816SMichael Neuling /* just copy interrupts */ 458c1fb6816SMichael Neuling LOAD_REG_IMMEDIATE(r5, __end_interrupts - _stext) 45954622f10SMohan Kumar M b 5f 46054622f10SMohan Kumar M3: 46154622f10SMohan Kumar M#endif 46254622f10SMohan Kumar M lis r5,(copy_to_here - _stext)@ha 46354622f10SMohan Kumar M addi r5,r5,(copy_to_here - _stext)@l /* # bytes of memory to copy */ 46454622f10SMohan Kumar M 46514cf11afSPaul Mackerras bl .copy_and_flush /* copy the first n bytes */ 46614cf11afSPaul Mackerras /* this includes the code being */ 46714cf11afSPaul Mackerras /* executed here. */ 468e31aa453SPaul Mackerras addis r8,r3,(4f - _stext)@ha /* Jump to the copy of this code */ 469e31aa453SPaul Mackerras addi r8,r8,(4f - _stext)@l /* that we just made */ 470e31aa453SPaul Mackerras mtctr r8 47114cf11afSPaul Mackerras bctr 47214cf11afSPaul Mackerras 47354622f10SMohan Kumar Mp_end: .llong _end - _stext 47454622f10SMohan Kumar M 475e31aa453SPaul Mackerras4: /* Now copy the rest of the kernel up to _end */ 476e31aa453SPaul Mackerras addis r5,r26,(p_end - _stext)@ha 477e31aa453SPaul Mackerras ld r5,(p_end - _stext)@l(r5) /* get _end */ 47854622f10SMohan Kumar M5: bl .copy_and_flush /* copy the rest */ 479e31aa453SPaul Mackerras 480e31aa453SPaul Mackerras9: b .start_here_multiplatform 481e31aa453SPaul Mackerras 48214cf11afSPaul Mackerras/* 48314cf11afSPaul Mackerras * Copy routine used to copy the kernel to start at physical address 0 48414cf11afSPaul Mackerras * and flush and invalidate the caches as needed. 48514cf11afSPaul Mackerras * r3 = dest addr, r4 = source addr, r5 = copy limit, r6 = start offset 48614cf11afSPaul Mackerras * on exit, r3, r4, r5 are unchanged, r6 is updated to be >= r5. 48714cf11afSPaul Mackerras * 48814cf11afSPaul Mackerras * Note: this routine *only* clobbers r0, r6 and lr 48914cf11afSPaul Mackerras */ 49014cf11afSPaul Mackerras_GLOBAL(copy_and_flush) 49114cf11afSPaul Mackerras addi r5,r5,-8 49214cf11afSPaul Mackerras addi r6,r6,-8 4935a2fe38dSOlof Johansson4: li r0,8 /* Use the smallest common */ 49414cf11afSPaul Mackerras /* denominator cache line */ 49514cf11afSPaul Mackerras /* size. This results in */ 49614cf11afSPaul Mackerras /* extra cache line flushes */ 49714cf11afSPaul Mackerras /* but operation is correct. */ 49814cf11afSPaul Mackerras /* Can't get cache line size */ 49914cf11afSPaul Mackerras /* from NACA as it is being */ 50014cf11afSPaul Mackerras /* moved too. */ 50114cf11afSPaul Mackerras 50214cf11afSPaul Mackerras mtctr r0 /* put # words/line in ctr */ 50314cf11afSPaul Mackerras3: addi r6,r6,8 /* copy a cache line */ 50414cf11afSPaul Mackerras ldx r0,r6,r4 50514cf11afSPaul Mackerras stdx r0,r6,r3 50614cf11afSPaul Mackerras bdnz 3b 50714cf11afSPaul Mackerras dcbst r6,r3 /* write it to memory */ 50814cf11afSPaul Mackerras sync 50914cf11afSPaul Mackerras icbi r6,r3 /* flush the icache line */ 51014cf11afSPaul Mackerras cmpld 0,r6,r5 51114cf11afSPaul Mackerras blt 4b 51214cf11afSPaul Mackerras sync 51314cf11afSPaul Mackerras addi r5,r5,8 51414cf11afSPaul Mackerras addi r6,r6,8 51529ce3c50SMichael Neuling isync 51614cf11afSPaul Mackerras blr 51714cf11afSPaul Mackerras 51814cf11afSPaul Mackerras.align 8 51914cf11afSPaul Mackerrascopy_to_here: 52014cf11afSPaul Mackerras 52114cf11afSPaul Mackerras#ifdef CONFIG_SMP 52214cf11afSPaul Mackerras#ifdef CONFIG_PPC_PMAC 52314cf11afSPaul Mackerras/* 52414cf11afSPaul Mackerras * On PowerMac, secondary processors starts from the reset vector, which 52514cf11afSPaul Mackerras * is temporarily turned into a call to one of the functions below. 52614cf11afSPaul Mackerras */ 52714cf11afSPaul Mackerras .section ".text"; 52814cf11afSPaul Mackerras .align 2 ; 52914cf11afSPaul Mackerras 53035499c01SPaul Mackerras .globl __secondary_start_pmac_0 53135499c01SPaul Mackerras__secondary_start_pmac_0: 53235499c01SPaul Mackerras /* NB the entries for cpus 0, 1, 2 must each occupy 8 bytes. */ 53335499c01SPaul Mackerras li r24,0 53435499c01SPaul Mackerras b 1f 53514cf11afSPaul Mackerras li r24,1 53635499c01SPaul Mackerras b 1f 53714cf11afSPaul Mackerras li r24,2 53835499c01SPaul Mackerras b 1f 53914cf11afSPaul Mackerras li r24,3 54035499c01SPaul Mackerras1: 54114cf11afSPaul Mackerras 54214cf11afSPaul Mackerras_GLOBAL(pmac_secondary_start) 54314cf11afSPaul Mackerras /* turn on 64-bit mode */ 54414cf11afSPaul Mackerras bl .enable_64b_mode 54514cf11afSPaul Mackerras 546c478b581SBenjamin Herrenschmidt li r0,0 547c478b581SBenjamin Herrenschmidt mfspr r3,SPRN_HID4 548c478b581SBenjamin Herrenschmidt rldimi r3,r0,40,23 /* clear bit 23 (rm_ci) */ 549c478b581SBenjamin Herrenschmidt sync 550c478b581SBenjamin Herrenschmidt mtspr SPRN_HID4,r3 551c478b581SBenjamin Herrenschmidt isync 552c478b581SBenjamin Herrenschmidt sync 553c478b581SBenjamin Herrenschmidt slbia 554c478b581SBenjamin Herrenschmidt 555e31aa453SPaul Mackerras /* get TOC pointer (real address) */ 556e31aa453SPaul Mackerras bl .relative_toc 5571fbe9cf2SAnton Blanchard tovirt(r2,r2) 558e31aa453SPaul Mackerras 55914cf11afSPaul Mackerras /* Copy some CPU settings from CPU 0 */ 560f39b7a55SOlof Johansson bl .__restore_cpu_ppc970 56114cf11afSPaul Mackerras 56214cf11afSPaul Mackerras /* pSeries do that early though I don't think we really need it */ 56314cf11afSPaul Mackerras mfmsr r3 56414cf11afSPaul Mackerras ori r3,r3,MSR_RI 56514cf11afSPaul Mackerras mtmsrd r3 /* RI on */ 56614cf11afSPaul Mackerras 56714cf11afSPaul Mackerras /* Set up a paca value for this processor. */ 5681426d5a3SMichael Ellerman LOAD_REG_ADDR(r4,paca) /* Load paca pointer */ 5691426d5a3SMichael Ellerman ld r4,0(r4) /* Get base vaddr of paca array */ 57014cf11afSPaul Mackerras mulli r13,r24,PACA_SIZE /* Calculate vaddr of right paca */ 57114cf11afSPaul Mackerras add r13,r13,r4 /* for this processor. */ 5722dd60d79SBenjamin Herrenschmidt SET_PACA(r13) /* Save vaddr of paca in an SPRG*/ 57314cf11afSPaul Mackerras 57462cc67b9SBenjamin Herrenschmidt /* Mark interrupts soft and hard disabled (they might be enabled 57562cc67b9SBenjamin Herrenschmidt * in the PACA when doing hotplug) 57662cc67b9SBenjamin Herrenschmidt */ 57762cc67b9SBenjamin Herrenschmidt li r0,0 57862cc67b9SBenjamin Herrenschmidt stb r0,PACASOFTIRQEN(r13) 5797230c564SBenjamin Herrenschmidt li r0,PACA_IRQ_HARD_DIS 5807230c564SBenjamin Herrenschmidt stb r0,PACAIRQHAPPENED(r13) 58162cc67b9SBenjamin Herrenschmidt 58214cf11afSPaul Mackerras /* Create a temp kernel stack for use before relocation is on. */ 58314cf11afSPaul Mackerras ld r1,PACAEMERGSP(r13) 58414cf11afSPaul Mackerras subi r1,r1,STACK_FRAME_OVERHEAD 58514cf11afSPaul Mackerras 586c705677eSStephen Rothwell b __secondary_start 58714cf11afSPaul Mackerras 58814cf11afSPaul Mackerras#endif /* CONFIG_PPC_PMAC */ 58914cf11afSPaul Mackerras 59014cf11afSPaul Mackerras/* 59114cf11afSPaul Mackerras * This function is called after the master CPU has released the 59214cf11afSPaul Mackerras * secondary processors. The execution environment is relocation off. 59314cf11afSPaul Mackerras * The paca for this processor has the following fields initialized at 59414cf11afSPaul Mackerras * this point: 59514cf11afSPaul Mackerras * 1. Processor number 59614cf11afSPaul Mackerras * 2. Segment table pointer (virtual address) 59714cf11afSPaul Mackerras * On entry the following are set: 5984f8cf36fSBenjamin Herrenschmidt * r1 = stack pointer (real addr of temp stack) 59914cf11afSPaul Mackerras * r24 = cpu# (in Linux terms) 60014cf11afSPaul Mackerras * r13 = paca virtual address 601ee43eb78SBenjamin Herrenschmidt * SPRG_PACA = paca virtual address 60214cf11afSPaul Mackerras */ 6032d27cfd3SBenjamin Herrenschmidt .section ".text"; 6042d27cfd3SBenjamin Herrenschmidt .align 2 ; 6052d27cfd3SBenjamin Herrenschmidt 606fc68e869SStephen Rothwell .globl __secondary_start 607c705677eSStephen Rothwell__secondary_start: 608799d6046SPaul Mackerras /* Set thread priority to MEDIUM */ 609799d6046SPaul Mackerras HMT_MEDIUM 61014cf11afSPaul Mackerras 6114f8cf36fSBenjamin Herrenschmidt /* Initialize the kernel stack */ 612e58c3495SDavid Gibson LOAD_REG_ADDR(r3, current_set) 61314cf11afSPaul Mackerras sldi r28,r24,3 /* get current_set[cpu#] */ 61454a83404SMichael Neuling ldx r14,r3,r28 61554a83404SMichael Neuling addi r14,r14,THREAD_SIZE-STACK_FRAME_OVERHEAD 61654a83404SMichael Neuling std r14,PACAKSAVE(r13) 61714cf11afSPaul Mackerras 618f761622eSMatt Evans /* Do early setup for that CPU (stab, slb, hash table pointer) */ 619f761622eSMatt Evans bl .early_setup_secondary 620f761622eSMatt Evans 62154a83404SMichael Neuling /* 62254a83404SMichael Neuling * setup the new stack pointer, but *don't* use this until 62354a83404SMichael Neuling * translation is on. 62454a83404SMichael Neuling */ 62554a83404SMichael Neuling mr r1, r14 62654a83404SMichael Neuling 627799d6046SPaul Mackerras /* Clear backchain so we get nice backtraces */ 62814cf11afSPaul Mackerras li r7,0 62914cf11afSPaul Mackerras mtlr r7 63014cf11afSPaul Mackerras 6317230c564SBenjamin Herrenschmidt /* Mark interrupts soft and hard disabled (they might be enabled 6327230c564SBenjamin Herrenschmidt * in the PACA when doing hotplug) 6337230c564SBenjamin Herrenschmidt */ 6344f8cf36fSBenjamin Herrenschmidt stb r7,PACASOFTIRQEN(r13) 6357230c564SBenjamin Herrenschmidt li r0,PACA_IRQ_HARD_DIS 6367230c564SBenjamin Herrenschmidt stb r0,PACAIRQHAPPENED(r13) 6374f8cf36fSBenjamin Herrenschmidt 63814cf11afSPaul Mackerras /* enable MMU and jump to start_secondary */ 639e58c3495SDavid Gibson LOAD_REG_ADDR(r3, .start_secondary_prolog) 640e58c3495SDavid Gibson LOAD_REG_IMMEDIATE(r4, MSR_KERNEL) 641d04c56f7SPaul Mackerras 642b5bbeb23SPaul Mackerras mtspr SPRN_SRR0,r3 643b5bbeb23SPaul Mackerras mtspr SPRN_SRR1,r4 6442d27cfd3SBenjamin Herrenschmidt RFI 64514cf11afSPaul Mackerras b . /* prevent speculative execution */ 64614cf11afSPaul Mackerras 64714cf11afSPaul Mackerras/* 64814cf11afSPaul Mackerras * Running with relocation on at this point. All we want to do is 649e31aa453SPaul Mackerras * zero the stack back-chain pointer and get the TOC virtual address 650e31aa453SPaul Mackerras * before going into C code. 65114cf11afSPaul Mackerras */ 65214cf11afSPaul Mackerras_GLOBAL(start_secondary_prolog) 653e31aa453SPaul Mackerras ld r2,PACATOC(r13) 65414cf11afSPaul Mackerras li r3,0 65514cf11afSPaul Mackerras std r3,0(r1) /* Zero the stack frame pointer */ 65614cf11afSPaul Mackerras bl .start_secondary 657799d6046SPaul Mackerras b . 6588dbce53cSVaidyanathan Srinivasan/* 6598dbce53cSVaidyanathan Srinivasan * Reset stack pointer and call start_secondary 6608dbce53cSVaidyanathan Srinivasan * to continue with online operation when woken up 6618dbce53cSVaidyanathan Srinivasan * from cede in cpu offline. 6628dbce53cSVaidyanathan Srinivasan */ 6638dbce53cSVaidyanathan Srinivasan_GLOBAL(start_secondary_resume) 6648dbce53cSVaidyanathan Srinivasan ld r1,PACAKSAVE(r13) /* Reload kernel stack pointer */ 6658dbce53cSVaidyanathan Srinivasan li r3,0 6668dbce53cSVaidyanathan Srinivasan std r3,0(r1) /* Zero the stack frame pointer */ 6678dbce53cSVaidyanathan Srinivasan bl .start_secondary 6688dbce53cSVaidyanathan Srinivasan b . 66914cf11afSPaul Mackerras#endif 67014cf11afSPaul Mackerras 67114cf11afSPaul Mackerras/* 67214cf11afSPaul Mackerras * This subroutine clobbers r11 and r12 67314cf11afSPaul Mackerras */ 67414cf11afSPaul Mackerras_GLOBAL(enable_64b_mode) 67514cf11afSPaul Mackerras mfmsr r11 /* grab the current MSR */ 6762d27cfd3SBenjamin Herrenschmidt#ifdef CONFIG_PPC_BOOK3E 6772d27cfd3SBenjamin Herrenschmidt oris r11,r11,0x8000 /* CM bit set, we'll set ICM later */ 6782d27cfd3SBenjamin Herrenschmidt mtmsr r11 6792d27cfd3SBenjamin Herrenschmidt#else /* CONFIG_PPC_BOOK3E */ 6809f0b0793SMichael Ellerman li r12,(MSR_64BIT | MSR_ISF)@highest 681e31aa453SPaul Mackerras sldi r12,r12,48 68214cf11afSPaul Mackerras or r11,r11,r12 68314cf11afSPaul Mackerras mtmsrd r11 68414cf11afSPaul Mackerras isync 6852d27cfd3SBenjamin Herrenschmidt#endif 68614cf11afSPaul Mackerras blr 68714cf11afSPaul Mackerras 68814cf11afSPaul Mackerras/* 689e31aa453SPaul Mackerras * This puts the TOC pointer into r2, offset by 0x8000 (as expected 690e31aa453SPaul Mackerras * by the toolchain). It computes the correct value for wherever we 691e31aa453SPaul Mackerras * are running at the moment, using position-independent code. 6921fbe9cf2SAnton Blanchard * 6931fbe9cf2SAnton Blanchard * Note: The compiler constructs pointers using offsets from the 6941fbe9cf2SAnton Blanchard * TOC in -mcmodel=medium mode. After we relocate to 0 but before 6951fbe9cf2SAnton Blanchard * the MMU is on we need our TOC to be a virtual address otherwise 6961fbe9cf2SAnton Blanchard * these pointers will be real addresses which may get stored and 6971fbe9cf2SAnton Blanchard * accessed later with the MMU on. We use tovirt() at the call 6981fbe9cf2SAnton Blanchard * sites to handle this. 699e31aa453SPaul Mackerras */ 700e31aa453SPaul Mackerras_GLOBAL(relative_toc) 701e31aa453SPaul Mackerras mflr r0 702e31aa453SPaul Mackerras bcl 20,31,$+4 703e550592eSBenjamin Herrenschmidt0: mflr r11 704e550592eSBenjamin Herrenschmidt ld r2,(p_toc - 0b)(r11) 705e550592eSBenjamin Herrenschmidt add r2,r2,r11 706e31aa453SPaul Mackerras mtlr r0 707e31aa453SPaul Mackerras blr 708e31aa453SPaul Mackerras 7095b63fee1SAnton Blanchard.balign 8 710e31aa453SPaul Mackerrasp_toc: .llong __toc_start + 0x8000 - 0b 711e31aa453SPaul Mackerras 712e31aa453SPaul Mackerras/* 71314cf11afSPaul Mackerras * This is where the main kernel code starts. 71414cf11afSPaul Mackerras */ 715939e60f6SStephen Rothwell_INIT_STATIC(start_here_multiplatform) 7161fbe9cf2SAnton Blanchard /* set up the TOC */ 717e31aa453SPaul Mackerras bl .relative_toc 7181fbe9cf2SAnton Blanchard tovirt(r2,r2) 71914cf11afSPaul Mackerras 72014cf11afSPaul Mackerras /* Clear out the BSS. It may have been done in prom_init, 72114cf11afSPaul Mackerras * already but that's irrelevant since prom_init will soon 72214cf11afSPaul Mackerras * be detached from the kernel completely. Besides, we need 72314cf11afSPaul Mackerras * to clear it now for kexec-style entry. 72414cf11afSPaul Mackerras */ 725e31aa453SPaul Mackerras LOAD_REG_ADDR(r11,__bss_stop) 726e31aa453SPaul Mackerras LOAD_REG_ADDR(r8,__bss_start) 72714cf11afSPaul Mackerras sub r11,r11,r8 /* bss size */ 72814cf11afSPaul Mackerras addi r11,r11,7 /* round up to an even double word */ 729e31aa453SPaul Mackerras srdi. r11,r11,3 /* shift right by 3 */ 73014cf11afSPaul Mackerras beq 4f 73114cf11afSPaul Mackerras addi r8,r8,-8 73214cf11afSPaul Mackerras li r0,0 73314cf11afSPaul Mackerras mtctr r11 /* zero this many doublewords */ 73414cf11afSPaul Mackerras3: stdu r0,8(r8) 73514cf11afSPaul Mackerras bdnz 3b 73614cf11afSPaul Mackerras4: 73714cf11afSPaul Mackerras 738daea1175SBenjamin Herrenschmidt#ifdef CONFIG_PPC_EARLY_DEBUG_OPAL 739daea1175SBenjamin Herrenschmidt /* Setup OPAL entry */ 740ab7f961aSBenjamin Herrenschmidt LOAD_REG_ADDR(r11, opal) 741daea1175SBenjamin Herrenschmidt std r28,0(r11); 742daea1175SBenjamin Herrenschmidt std r29,8(r11); 743daea1175SBenjamin Herrenschmidt#endif 744daea1175SBenjamin Herrenschmidt 7452d27cfd3SBenjamin Herrenschmidt#ifndef CONFIG_PPC_BOOK3E 74614cf11afSPaul Mackerras mfmsr r6 74714cf11afSPaul Mackerras ori r6,r6,MSR_RI 74814cf11afSPaul Mackerras mtmsrd r6 /* RI on */ 7492d27cfd3SBenjamin Herrenschmidt#endif 75014cf11afSPaul Mackerras 751549e8152SPaul Mackerras#ifdef CONFIG_RELOCATABLE 752549e8152SPaul Mackerras /* Save the physical address we're running at in kernstart_addr */ 753549e8152SPaul Mackerras LOAD_REG_ADDR(r4, kernstart_addr) 754549e8152SPaul Mackerras clrldi r0,r25,2 755549e8152SPaul Mackerras std r0,0(r4) 756549e8152SPaul Mackerras#endif 757549e8152SPaul Mackerras 758e31aa453SPaul Mackerras /* The following gets the stack set up with the regs */ 75914cf11afSPaul Mackerras /* pointing to the real addr of the kernel stack. This is */ 76014cf11afSPaul Mackerras /* all done to support the C function call below which sets */ 76114cf11afSPaul Mackerras /* up the htab. This is done because we have relocated the */ 76214cf11afSPaul Mackerras /* kernel but are still running in real mode. */ 76314cf11afSPaul Mackerras 764e31aa453SPaul Mackerras LOAD_REG_ADDR(r3,init_thread_union) 76514cf11afSPaul Mackerras 766e31aa453SPaul Mackerras /* set up a stack pointer */ 76714cf11afSPaul Mackerras addi r1,r3,THREAD_SIZE 76814cf11afSPaul Mackerras li r0,0 76914cf11afSPaul Mackerras stdu r0,-STACK_FRAME_OVERHEAD(r1) 77014cf11afSPaul Mackerras 77114cf11afSPaul Mackerras /* Do very early kernel initializations, including initial hash table, 77214cf11afSPaul Mackerras * stab and slb setup before we turn on relocation. */ 77314cf11afSPaul Mackerras 77414cf11afSPaul Mackerras /* Restore parameters passed from prom_init/kexec */ 77514cf11afSPaul Mackerras mr r3,r31 776ee43eb78SBenjamin Herrenschmidt bl .early_setup /* also sets r13 and SPRG_PACA */ 77714cf11afSPaul Mackerras 778e31aa453SPaul Mackerras LOAD_REG_ADDR(r3, .start_here_common) 779e31aa453SPaul Mackerras ld r4,PACAKMSR(r13) 780b5bbeb23SPaul Mackerras mtspr SPRN_SRR0,r3 781b5bbeb23SPaul Mackerras mtspr SPRN_SRR1,r4 7822d27cfd3SBenjamin Herrenschmidt RFI 78314cf11afSPaul Mackerras b . /* prevent speculative execution */ 78414cf11afSPaul Mackerras 78514cf11afSPaul Mackerras /* This is where all platforms converge execution */ 786fc68e869SStephen Rothwell_INIT_GLOBAL(start_here_common) 78714cf11afSPaul Mackerras /* relocation is on at this point */ 78814cf11afSPaul Mackerras std r1,PACAKSAVE(r13) 78914cf11afSPaul Mackerras 790e31aa453SPaul Mackerras /* Load the TOC (virtual address) */ 791e31aa453SPaul Mackerras ld r2,PACATOC(r13) 792e31aa453SPaul Mackerras 7937230c564SBenjamin Herrenschmidt /* Do more system initializations in virtual mode */ 79414cf11afSPaul Mackerras bl .setup_system 79514cf11afSPaul Mackerras 7967230c564SBenjamin Herrenschmidt /* Mark interrupts soft and hard disabled (they might be enabled 7977230c564SBenjamin Herrenschmidt * in the PACA when doing hotplug) 7987230c564SBenjamin Herrenschmidt */ 7997230c564SBenjamin Herrenschmidt li r0,0 8007230c564SBenjamin Herrenschmidt stb r0,PACASOFTIRQEN(r13) 8017230c564SBenjamin Herrenschmidt li r0,PACA_IRQ_HARD_DIS 8027230c564SBenjamin Herrenschmidt stb r0,PACAIRQHAPPENED(r13) 80314cf11afSPaul Mackerras 8047230c564SBenjamin Herrenschmidt /* Generic kernel entry */ 80514cf11afSPaul Mackerras bl .start_kernel 80614cf11afSPaul Mackerras 807f1870f77SAnton Blanchard /* Not reached */ 808f1870f77SAnton Blanchard BUG_OPCODE 80914cf11afSPaul Mackerras 81014cf11afSPaul Mackerras/* 81114cf11afSPaul Mackerras * We put a few things here that have to be page-aligned. 81214cf11afSPaul Mackerras * This stuff goes at the beginning of the bss, which is page-aligned. 81314cf11afSPaul Mackerras */ 81414cf11afSPaul Mackerras .section ".bss" 81514cf11afSPaul Mackerras 81614cf11afSPaul Mackerras .align PAGE_SHIFT 81714cf11afSPaul Mackerras 81814cf11afSPaul Mackerras .globl empty_zero_page 81914cf11afSPaul Mackerrasempty_zero_page: 82014cf11afSPaul Mackerras .space PAGE_SIZE 82114cf11afSPaul Mackerras 82214cf11afSPaul Mackerras .globl swapper_pg_dir 82314cf11afSPaul Mackerrasswapper_pg_dir: 824ee7a76daSStephen Rothwell .space PGD_TABLE_SIZE 825