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> 26c141611fSPaul Gortmaker#include <linux/init.h> 27b5bbeb23SPaul Mackerras#include <asm/reg.h> 2814cf11afSPaul Mackerras#include <asm/page.h> 2914cf11afSPaul Mackerras#include <asm/mmu.h> 3014cf11afSPaul Mackerras#include <asm/ppc_asm.h> 3114cf11afSPaul Mackerras#include <asm/asm-offsets.h> 3214cf11afSPaul Mackerras#include <asm/bug.h> 3314cf11afSPaul Mackerras#include <asm/cputable.h> 3414cf11afSPaul Mackerras#include <asm/setup.h> 3514cf11afSPaul Mackerras#include <asm/hvcall.h> 366cb7bfebSDavid Gibson#include <asm/thread_info.h> 373f639ee8SStephen Rothwell#include <asm/firmware.h> 3816a15a30SStephen Rothwell#include <asm/page_64.h> 39945feb17SBenjamin Herrenschmidt#include <asm/irqflags.h> 402191d657SAlexander Graf#include <asm/kvm_book3s_asm.h> 4146f52210SStephen Rothwell#include <asm/ptrace.h> 427230c564SBenjamin Herrenschmidt#include <asm/hw_irq.h> 4314cf11afSPaul Mackerras 4425985edcSLucas De Marchi/* The physical memory is laid out such that the secondary processor 450ebc4cdaSBenjamin Herrenschmidt * spin code sits at 0x0000...0x00ff. On server, the vectors follow 460ebc4cdaSBenjamin Herrenschmidt * using the layout described in exceptions-64s.S 4714cf11afSPaul Mackerras */ 4814cf11afSPaul Mackerras 4914cf11afSPaul Mackerras/* 5014cf11afSPaul Mackerras * Entering into this code we make the following assumptions: 510ebc4cdaSBenjamin Herrenschmidt * 520ebc4cdaSBenjamin Herrenschmidt * For pSeries or server processors: 5314cf11afSPaul Mackerras * 1. The MMU is off & open firmware is running in real mode. 5414cf11afSPaul Mackerras * 2. The kernel is entered at __start 5527f44888SBenjamin Herrenschmidt * -or- For OPAL entry: 5627f44888SBenjamin Herrenschmidt * 1. The MMU is off, processor in HV mode, primary CPU enters at 0 57daea1175SBenjamin Herrenschmidt * with device-tree in gpr3. We also get OPAL base in r8 and 58daea1175SBenjamin Herrenschmidt * entry in r9 for debugging purposes 5927f44888SBenjamin Herrenschmidt * 2. Secondary processors enter at 0x60 with PIR in gpr3 6014cf11afSPaul Mackerras * 610ebc4cdaSBenjamin Herrenschmidt * For Book3E processors: 620ebc4cdaSBenjamin Herrenschmidt * 1. The MMU is on running in AS0 in a state defined in ePAPR 630ebc4cdaSBenjamin Herrenschmidt * 2. The kernel is entered at __start 6414cf11afSPaul Mackerras */ 6514cf11afSPaul Mackerras 6614cf11afSPaul Mackerras .text 6714cf11afSPaul Mackerras .globl _stext 6814cf11afSPaul Mackerras_stext: 6914cf11afSPaul Mackerras_GLOBAL(__start) 7014cf11afSPaul Mackerras /* NOP this out unconditionally */ 7114cf11afSPaul MackerrasBEGIN_FTR_SECTION 725c0484e2SBenjamin Herrenschmidt FIXUP_ENDIAN 73b1576fecSAnton Blanchard b __start_initialization_multiplatform 7414cf11afSPaul MackerrasEND_FTR_SECTION(0, 1) 7514cf11afSPaul Mackerras 7614cf11afSPaul Mackerras /* Catch branch to 0 in real mode */ 7714cf11afSPaul Mackerras trap 7814cf11afSPaul Mackerras 792751b628SAnton Blanchard /* Secondary processors spin on this value until it becomes non-zero. 802751b628SAnton Blanchard * When non-zero, it contains the real address of the function the cpu 812751b628SAnton Blanchard * should jump to. 821f6a93e4SPaul Mackerras */ 837d4151b5SOlof Johansson .balign 8 8414cf11afSPaul Mackerras .globl __secondary_hold_spinloop 8514cf11afSPaul Mackerras__secondary_hold_spinloop: 8614cf11afSPaul Mackerras .llong 0x0 8714cf11afSPaul Mackerras 8814cf11afSPaul Mackerras /* Secondary processors write this value with their cpu # */ 8914cf11afSPaul Mackerras /* after they enter the spin loop immediately below. */ 9014cf11afSPaul Mackerras .globl __secondary_hold_acknowledge 9114cf11afSPaul Mackerras__secondary_hold_acknowledge: 9214cf11afSPaul Mackerras .llong 0x0 9314cf11afSPaul Mackerras 94928a3197SSonny Rao#ifdef CONFIG_RELOCATABLE 958b8b0cc1SMilton Miller /* This flag is set to 1 by a loader if the kernel should run 968b8b0cc1SMilton Miller * at the loaded address instead of the linked address. This 978b8b0cc1SMilton Miller * is used by kexec-tools to keep the the kdump kernel in the 988b8b0cc1SMilton Miller * crash_kernel region. The loader is responsible for 998b8b0cc1SMilton Miller * observing the alignment requirement. 1008b8b0cc1SMilton Miller */ 1018b8b0cc1SMilton Miller /* Do not move this variable as kexec-tools knows about it. */ 1028b8b0cc1SMilton Miller . = 0x5c 1038b8b0cc1SMilton Miller .globl __run_at_load 1048b8b0cc1SMilton Miller__run_at_load: 1058b8b0cc1SMilton Miller .long 0x72756e30 /* "run0" -- relocate to 0 by default */ 1068b8b0cc1SMilton Miller#endif 1078b8b0cc1SMilton Miller 10814cf11afSPaul Mackerras . = 0x60 10914cf11afSPaul Mackerras/* 11075423b7bSGeoff Levand * The following code is used to hold secondary processors 11175423b7bSGeoff Levand * in a spin loop after they have entered the kernel, but 11214cf11afSPaul Mackerras * before the bulk of the kernel has been relocated. This code 11314cf11afSPaul Mackerras * is relocated to physical address 0x60 before prom_init is run. 11414cf11afSPaul Mackerras * All of it must fit below the first exception vector at 0x100. 1151f6a93e4SPaul Mackerras * Use .globl here not _GLOBAL because we want __secondary_hold 1161f6a93e4SPaul Mackerras * to be the actual text address, not a descriptor. 11714cf11afSPaul Mackerras */ 1181f6a93e4SPaul Mackerras .globl __secondary_hold 1191f6a93e4SPaul Mackerras__secondary_hold: 1205c0484e2SBenjamin Herrenschmidt FIXUP_ENDIAN 1212d27cfd3SBenjamin Herrenschmidt#ifndef CONFIG_PPC_BOOK3E 12214cf11afSPaul Mackerras mfmsr r24 12314cf11afSPaul Mackerras ori r24,r24,MSR_RI 12414cf11afSPaul Mackerras mtmsrd r24 /* RI on */ 1252d27cfd3SBenjamin Herrenschmidt#endif 126f1870f77SAnton Blanchard /* Grab our physical cpu number */ 12714cf11afSPaul Mackerras mr r24,r3 12896f013feSJimi Xenidis /* stash r4 for book3e */ 12996f013feSJimi Xenidis mr r25,r4 13014cf11afSPaul Mackerras 13114cf11afSPaul Mackerras /* Tell the master cpu we're here */ 13214cf11afSPaul Mackerras /* Relocation is off & we are located at an address less */ 13314cf11afSPaul Mackerras /* than 0x100, so only need to grab low order offset. */ 134e31aa453SPaul Mackerras std r24,__secondary_hold_acknowledge-_stext(0) 13514cf11afSPaul Mackerras sync 13614cf11afSPaul Mackerras 13796f013feSJimi Xenidis li r26,0 13896f013feSJimi Xenidis#ifdef CONFIG_PPC_BOOK3E 13996f013feSJimi Xenidis tovirt(r26,r26) 14096f013feSJimi Xenidis#endif 14114cf11afSPaul Mackerras /* All secondary cpus wait here until told to start. */ 142cc7efbf9SAnton Blanchard100: ld r12,__secondary_hold_spinloop-_stext(r26) 143cc7efbf9SAnton Blanchard cmpdi 0,r12,0 1441f6a93e4SPaul Mackerras beq 100b 14514cf11afSPaul Mackerras 146f1870f77SAnton Blanchard#if defined(CONFIG_SMP) || defined(CONFIG_KEXEC) 14796f013feSJimi Xenidis#ifdef CONFIG_PPC_BOOK3E 148cc7efbf9SAnton Blanchard tovirt(r12,r12) 14996f013feSJimi Xenidis#endif 150cc7efbf9SAnton Blanchard mtctr r12 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 183*e16c8765SAndy Fleming#ifdef CONFIG_PPC_BOOK3E 184*e16c8765SAndy Fleming_GLOBAL(fsl_secondary_thread_init) 185*e16c8765SAndy Fleming /* Enable branch prediction */ 186*e16c8765SAndy Fleming lis r3,BUCSR_INIT@h 187*e16c8765SAndy Fleming ori r3,r3,BUCSR_INIT@l 188*e16c8765SAndy Fleming mtspr SPRN_BUCSR,r3 189*e16c8765SAndy Fleming isync 190*e16c8765SAndy Fleming 191*e16c8765SAndy Fleming /* 192*e16c8765SAndy Fleming * Fix PIR to match the linear numbering in the device tree. 193*e16c8765SAndy Fleming * 194*e16c8765SAndy Fleming * On e6500, the reset value of PIR uses the low three bits for 195*e16c8765SAndy Fleming * the thread within a core, and the upper bits for the core 196*e16c8765SAndy Fleming * number. There are two threads per core, so shift everything 197*e16c8765SAndy Fleming * but the low bit right by two bits so that the cpu numbering is 198*e16c8765SAndy Fleming * continuous. 199*e16c8765SAndy Fleming */ 200*e16c8765SAndy Fleming mfspr r3, SPRN_PIR 201*e16c8765SAndy Fleming rlwimi r3, r3, 30, 2, 30 202*e16c8765SAndy Fleming mtspr SPRN_PIR, r3 203*e16c8765SAndy Fleming#endif 204*e16c8765SAndy Fleming 2052d27cfd3SBenjamin Herrenschmidt_GLOBAL(generic_secondary_thread_init) 20614cf11afSPaul Mackerras mr r24,r3 20714cf11afSPaul Mackerras 20814cf11afSPaul Mackerras /* turn on 64-bit mode */ 209b1576fecSAnton Blanchard bl enable_64b_mode 21014cf11afSPaul Mackerras 2112d27cfd3SBenjamin Herrenschmidt /* get a valid TOC pointer, wherever we're mapped at */ 212b1576fecSAnton Blanchard bl relative_toc 2131fbe9cf2SAnton Blanchard tovirt(r2,r2) 214e31aa453SPaul Mackerras 2152d27cfd3SBenjamin Herrenschmidt#ifdef CONFIG_PPC_BOOK3E 2162d27cfd3SBenjamin Herrenschmidt /* Book3E initialization */ 2172d27cfd3SBenjamin Herrenschmidt mr r3,r24 218b1576fecSAnton Blanchard bl book3e_secondary_thread_init 2192d27cfd3SBenjamin Herrenschmidt#endif 2202d27cfd3SBenjamin Herrenschmidt b generic_secondary_common_init 2212d27cfd3SBenjamin Herrenschmidt 2222d27cfd3SBenjamin Herrenschmidt/* 2232d27cfd3SBenjamin Herrenschmidt * On pSeries and most other platforms, secondary processors spin 2242d27cfd3SBenjamin Herrenschmidt * in the following code. 2252d27cfd3SBenjamin Herrenschmidt * At entry, r3 = this processor's number (physical cpu id) 2262d27cfd3SBenjamin Herrenschmidt * 2272d27cfd3SBenjamin Herrenschmidt * On Book3E, r4 = 1 to indicate that the initial TLB entry for 2282d27cfd3SBenjamin Herrenschmidt * this core already exists (setup via some other mechanism such 2292d27cfd3SBenjamin Herrenschmidt * as SCOM before entry). 2302d27cfd3SBenjamin Herrenschmidt */ 2312d27cfd3SBenjamin Herrenschmidt_GLOBAL(generic_secondary_smp_init) 2325c0484e2SBenjamin Herrenschmidt FIXUP_ENDIAN 2332d27cfd3SBenjamin Herrenschmidt mr r24,r3 2342d27cfd3SBenjamin Herrenschmidt mr r25,r4 2352d27cfd3SBenjamin Herrenschmidt 2362d27cfd3SBenjamin Herrenschmidt /* turn on 64-bit mode */ 237b1576fecSAnton Blanchard bl enable_64b_mode 2382d27cfd3SBenjamin Herrenschmidt 2392d27cfd3SBenjamin Herrenschmidt /* get a valid TOC pointer, wherever we're mapped at */ 240b1576fecSAnton Blanchard bl relative_toc 2411fbe9cf2SAnton Blanchard tovirt(r2,r2) 2422d27cfd3SBenjamin Herrenschmidt 2432d27cfd3SBenjamin Herrenschmidt#ifdef CONFIG_PPC_BOOK3E 2442d27cfd3SBenjamin Herrenschmidt /* Book3E initialization */ 2452d27cfd3SBenjamin Herrenschmidt mr r3,r24 2462d27cfd3SBenjamin Herrenschmidt mr r4,r25 247b1576fecSAnton Blanchard bl book3e_secondary_core_init 2482d27cfd3SBenjamin Herrenschmidt#endif 2492d27cfd3SBenjamin Herrenschmidt 2502d27cfd3SBenjamin Herrenschmidtgeneric_secondary_common_init: 25114cf11afSPaul Mackerras /* Set up a paca value for this processor. Since we have the 25214cf11afSPaul Mackerras * physical cpu id in r24, we need to search the pacas to find 25314cf11afSPaul Mackerras * which logical id maps to our physical one. 25414cf11afSPaul Mackerras */ 2551426d5a3SMichael Ellerman LOAD_REG_ADDR(r13, paca) /* Load paca pointer */ 2561426d5a3SMichael Ellerman ld r13,0(r13) /* Get base vaddr of paca array */ 257768d18adSMilton Miller#ifndef CONFIG_SMP 258768d18adSMilton Miller addi r13,r13,PACA_SIZE /* know r13 if used accidentally */ 259b1576fecSAnton Blanchard b kexec_wait /* wait for next kernel if !SMP */ 260768d18adSMilton Miller#else 261768d18adSMilton Miller LOAD_REG_ADDR(r7, nr_cpu_ids) /* Load nr_cpu_ids address */ 262768d18adSMilton Miller lwz r7,0(r7) /* also the max paca allocated */ 26314cf11afSPaul Mackerras li r5,0 /* logical cpu id */ 26414cf11afSPaul Mackerras1: lhz r6,PACAHWCPUID(r13) /* Load HW procid from paca */ 26514cf11afSPaul Mackerras cmpw r6,r24 /* Compare to our id */ 26614cf11afSPaul Mackerras beq 2f 26714cf11afSPaul Mackerras addi r13,r13,PACA_SIZE /* Loop to next PACA on miss */ 26814cf11afSPaul Mackerras addi r5,r5,1 269768d18adSMilton Miller cmpw r5,r7 /* Check if more pacas exist */ 27014cf11afSPaul Mackerras blt 1b 27114cf11afSPaul Mackerras 27214cf11afSPaul Mackerras mr r3,r24 /* not found, copy phys to r3 */ 273b1576fecSAnton Blanchard b kexec_wait /* next kernel might do better */ 27414cf11afSPaul Mackerras 2752dd60d79SBenjamin Herrenschmidt2: SET_PACA(r13) 2762d27cfd3SBenjamin Herrenschmidt#ifdef CONFIG_PPC_BOOK3E 2772d27cfd3SBenjamin Herrenschmidt addi r12,r13,PACA_EXTLB /* and TLB exc frame in another */ 2782d27cfd3SBenjamin Herrenschmidt mtspr SPRN_SPRG_TLB_EXFRAME,r12 2792d27cfd3SBenjamin Herrenschmidt#endif 2802d27cfd3SBenjamin Herrenschmidt 28114cf11afSPaul Mackerras /* From now on, r24 is expected to be logical cpuid */ 28214cf11afSPaul Mackerras mr r24,r5 283b6f6b98aSSonny Rao 284f39b7a55SOlof Johansson /* See if we need to call a cpu state restore handler */ 285e31aa453SPaul Mackerras LOAD_REG_ADDR(r23, cur_cpu_spec) 286f39b7a55SOlof Johansson ld r23,0(r23) 2872751b628SAnton Blanchard ld r12,CPU_SPEC_RESTORE(r23) 2882751b628SAnton Blanchard cmpdi 0,r12,0 2899d07bc84SBenjamin Herrenschmidt beq 3f 2902751b628SAnton Blanchard#if !defined(_CALL_ELF) || _CALL_ELF != 2 2912751b628SAnton Blanchard ld r12,0(r12) 2922751b628SAnton Blanchard#endif 293cc7efbf9SAnton Blanchard mtctr r12 294f39b7a55SOlof Johansson bctrl 295f39b7a55SOlof Johansson 2967ac87abbSMatt Evans3: LOAD_REG_ADDR(r3, spinning_secondaries) /* Decrement spinning_secondaries */ 2979d07bc84SBenjamin Herrenschmidt lwarx r4,0,r3 2989d07bc84SBenjamin Herrenschmidt subi r4,r4,1 2999d07bc84SBenjamin Herrenschmidt stwcx. r4,0,r3 3009d07bc84SBenjamin Herrenschmidt bne 3b 3019d07bc84SBenjamin Herrenschmidt isync 3029d07bc84SBenjamin Herrenschmidt 3039d07bc84SBenjamin Herrenschmidt4: HMT_LOW 304ad0693eeSBenjamin Herrenschmidt lbz r23,PACAPROCSTART(r13) /* Test if this processor should */ 305ad0693eeSBenjamin Herrenschmidt /* start. */ 306ad0693eeSBenjamin Herrenschmidt cmpwi 0,r23,0 3079d07bc84SBenjamin Herrenschmidt beq 4b /* Loop until told to go */ 308ad0693eeSBenjamin Herrenschmidt 309ad0693eeSBenjamin Herrenschmidt sync /* order paca.run and cur_cpu_spec */ 3109d07bc84SBenjamin Herrenschmidt isync /* In case code patching happened */ 311ad0693eeSBenjamin Herrenschmidt 3129d07bc84SBenjamin Herrenschmidt /* Create a temp kernel stack for use before relocation is on. */ 31314cf11afSPaul Mackerras ld r1,PACAEMERGSP(r13) 31414cf11afSPaul Mackerras subi r1,r1,STACK_FRAME_OVERHEAD 31514cf11afSPaul Mackerras 316c705677eSStephen Rothwell b __secondary_start 317768d18adSMilton Miller#endif /* SMP */ 31814cf11afSPaul Mackerras 319e31aa453SPaul Mackerras/* 320e31aa453SPaul Mackerras * Turn the MMU off. 321e31aa453SPaul Mackerras * Assumes we're mapped EA == RA if the MMU is on. 322e31aa453SPaul Mackerras */ 3232d27cfd3SBenjamin Herrenschmidt#ifdef CONFIG_PPC_BOOK3S 3246a3bab90SAnton Blanchard__mmu_off: 32514cf11afSPaul Mackerras mfmsr r3 32614cf11afSPaul Mackerras andi. r0,r3,MSR_IR|MSR_DR 32714cf11afSPaul Mackerras beqlr 328e31aa453SPaul Mackerras mflr r4 32914cf11afSPaul Mackerras andc r3,r3,r0 33014cf11afSPaul Mackerras mtspr SPRN_SRR0,r4 33114cf11afSPaul Mackerras mtspr SPRN_SRR1,r3 33214cf11afSPaul Mackerras sync 33314cf11afSPaul Mackerras rfid 33414cf11afSPaul Mackerras b . /* prevent speculative execution */ 3352d27cfd3SBenjamin Herrenschmidt#endif 33614cf11afSPaul Mackerras 33714cf11afSPaul Mackerras 33814cf11afSPaul Mackerras/* 33914cf11afSPaul Mackerras * Here is our main kernel entry point. We support currently 2 kind of entries 34014cf11afSPaul Mackerras * depending on the value of r5. 34114cf11afSPaul Mackerras * 34214cf11afSPaul Mackerras * r5 != NULL -> OF entry, we go to prom_init, "legacy" parameter content 34314cf11afSPaul Mackerras * in r3...r7 34414cf11afSPaul Mackerras * 34514cf11afSPaul Mackerras * r5 == NULL -> kexec style entry. r3 is a physical pointer to the 34614cf11afSPaul Mackerras * DT block, r4 is a physical pointer to the kernel itself 34714cf11afSPaul Mackerras * 34814cf11afSPaul Mackerras */ 3496a3bab90SAnton Blanchard__start_initialization_multiplatform: 350e31aa453SPaul Mackerras /* Make sure we are running in 64 bits mode */ 351b1576fecSAnton Blanchard bl enable_64b_mode 352e31aa453SPaul Mackerras 353e31aa453SPaul Mackerras /* Get TOC pointer (current runtime address) */ 354b1576fecSAnton Blanchard bl relative_toc 355e31aa453SPaul Mackerras 356e31aa453SPaul Mackerras /* find out where we are now */ 357e31aa453SPaul Mackerras bcl 20,31,$+4 358e31aa453SPaul Mackerras0: mflr r26 /* r26 = runtime addr here */ 359e31aa453SPaul Mackerras addis r26,r26,(_stext - 0b)@ha 360e31aa453SPaul Mackerras addi r26,r26,(_stext - 0b)@l /* current runtime base addr */ 361e31aa453SPaul Mackerras 36214cf11afSPaul Mackerras /* 36314cf11afSPaul Mackerras * Are we booted from a PROM Of-type client-interface ? 36414cf11afSPaul Mackerras */ 36514cf11afSPaul Mackerras cmpldi cr0,r5,0 366939e60f6SStephen Rothwell beq 1f 367b1576fecSAnton Blanchard b __boot_from_prom /* yes -> prom */ 368939e60f6SStephen Rothwell1: 36914cf11afSPaul Mackerras /* Save parameters */ 37014cf11afSPaul Mackerras mr r31,r3 37114cf11afSPaul Mackerras mr r30,r4 372daea1175SBenjamin Herrenschmidt#ifdef CONFIG_PPC_EARLY_DEBUG_OPAL 373daea1175SBenjamin Herrenschmidt /* Save OPAL entry */ 374daea1175SBenjamin Herrenschmidt mr r28,r8 375daea1175SBenjamin Herrenschmidt mr r29,r9 376daea1175SBenjamin Herrenschmidt#endif 37714cf11afSPaul Mackerras 3782d27cfd3SBenjamin Herrenschmidt#ifdef CONFIG_PPC_BOOK3E 379b1576fecSAnton Blanchard bl start_initialization_book3e 380b1576fecSAnton Blanchard b __after_prom_start 3812d27cfd3SBenjamin Herrenschmidt#else 38214cf11afSPaul Mackerras /* Setup some critical 970 SPRs before switching MMU off */ 383f39b7a55SOlof Johansson mfspr r0,SPRN_PVR 384f39b7a55SOlof Johansson srwi r0,r0,16 385f39b7a55SOlof Johansson cmpwi r0,0x39 /* 970 */ 386f39b7a55SOlof Johansson beq 1f 387f39b7a55SOlof Johansson cmpwi r0,0x3c /* 970FX */ 388f39b7a55SOlof Johansson beq 1f 389f39b7a55SOlof Johansson cmpwi r0,0x44 /* 970MP */ 390190a24f5SOlof Johansson beq 1f 391190a24f5SOlof Johansson cmpwi r0,0x45 /* 970GX */ 392f39b7a55SOlof Johansson bne 2f 393b1576fecSAnton Blanchard1: bl __cpu_preinit_ppc970 394f39b7a55SOlof Johansson2: 39514cf11afSPaul Mackerras 396e31aa453SPaul Mackerras /* Switch off MMU if not already off */ 397b1576fecSAnton Blanchard bl __mmu_off 398b1576fecSAnton Blanchard b __after_prom_start 3992d27cfd3SBenjamin Herrenschmidt#endif /* CONFIG_PPC_BOOK3E */ 40014cf11afSPaul Mackerras 4016a3bab90SAnton Blanchard__boot_from_prom: 40228794d34SBenjamin Herrenschmidt#ifdef CONFIG_PPC_OF_BOOT_TRAMPOLINE 40314cf11afSPaul Mackerras /* Save parameters */ 40414cf11afSPaul Mackerras mr r31,r3 40514cf11afSPaul Mackerras mr r30,r4 40614cf11afSPaul Mackerras mr r29,r5 40714cf11afSPaul Mackerras mr r28,r6 40814cf11afSPaul Mackerras mr r27,r7 40914cf11afSPaul Mackerras 4106088857bSOlaf Hering /* 4116088857bSOlaf Hering * Align the stack to 16-byte boundary 4126088857bSOlaf Hering * Depending on the size and layout of the ELF sections in the initial 413e31aa453SPaul Mackerras * boot binary, the stack pointer may be unaligned on PowerMac 4146088857bSOlaf Hering */ 415c05b4770SLinus Torvalds rldicr r1,r1,0,59 416c05b4770SLinus Torvalds 417549e8152SPaul Mackerras#ifdef CONFIG_RELOCATABLE 418549e8152SPaul Mackerras /* Relocate code for where we are now */ 419549e8152SPaul Mackerras mr r3,r26 420b1576fecSAnton Blanchard bl relocate 421549e8152SPaul Mackerras#endif 422549e8152SPaul Mackerras 42314cf11afSPaul Mackerras /* Restore parameters */ 42414cf11afSPaul Mackerras mr r3,r31 42514cf11afSPaul Mackerras mr r4,r30 42614cf11afSPaul Mackerras mr r5,r29 42714cf11afSPaul Mackerras mr r6,r28 42814cf11afSPaul Mackerras mr r7,r27 42914cf11afSPaul Mackerras 43014cf11afSPaul Mackerras /* Do all of the interaction with OF client interface */ 431549e8152SPaul Mackerras mr r8,r26 432b1576fecSAnton Blanchard bl prom_init 43328794d34SBenjamin Herrenschmidt#endif /* #CONFIG_PPC_OF_BOOT_TRAMPOLINE */ 43428794d34SBenjamin Herrenschmidt 43528794d34SBenjamin Herrenschmidt /* We never return. We also hit that trap if trying to boot 43628794d34SBenjamin Herrenschmidt * from OF while CONFIG_PPC_OF_BOOT_TRAMPOLINE isn't selected */ 43714cf11afSPaul Mackerras trap 43814cf11afSPaul Mackerras 4396a3bab90SAnton Blanchard__after_prom_start: 440549e8152SPaul Mackerras#ifdef CONFIG_RELOCATABLE 441549e8152SPaul Mackerras /* process relocations for the final address of the kernel */ 442549e8152SPaul Mackerras lis r25,PAGE_OFFSET@highest /* compute virtual base of kernel */ 443549e8152SPaul Mackerras sldi r25,r25,32 4448b8b0cc1SMilton Miller lwz r7,__run_at_load-_stext(r26) 445928a3197SSonny Rao cmplwi cr0,r7,1 /* flagged to stay where we are ? */ 44654622f10SMohan Kumar M bne 1f 44754622f10SMohan Kumar M add r25,r25,r26 44854622f10SMohan Kumar M1: mr r3,r25 449b1576fecSAnton Blanchard bl relocate 450549e8152SPaul Mackerras#endif 45114cf11afSPaul Mackerras 45214cf11afSPaul Mackerras/* 453e31aa453SPaul Mackerras * We need to run with _stext at physical address PHYSICAL_START. 45414cf11afSPaul Mackerras * This will leave some code in the first 256B of 45514cf11afSPaul Mackerras * real memory, which are reserved for software use. 45614cf11afSPaul Mackerras * 45714cf11afSPaul Mackerras * Note: This process overwrites the OF exception vectors. 45814cf11afSPaul Mackerras */ 459549e8152SPaul Mackerras li r3,0 /* target addr */ 4602d27cfd3SBenjamin Herrenschmidt#ifdef CONFIG_PPC_BOOK3E 4612d27cfd3SBenjamin Herrenschmidt tovirt(r3,r3) /* on booke, we already run at PAGE_OFFSET */ 4622d27cfd3SBenjamin Herrenschmidt#endif 463549e8152SPaul Mackerras mr. r4,r26 /* In some cases the loader may */ 464e31aa453SPaul Mackerras beq 9f /* have already put us at zero */ 46514cf11afSPaul Mackerras li r6,0x100 /* Start offset, the first 0x100 */ 46614cf11afSPaul Mackerras /* bytes were copied earlier. */ 4672d27cfd3SBenjamin Herrenschmidt#ifdef CONFIG_PPC_BOOK3E 4682d27cfd3SBenjamin Herrenschmidt tovirt(r6,r6) /* on booke, we already run at PAGE_OFFSET */ 4692d27cfd3SBenjamin Herrenschmidt#endif 47014cf11afSPaul Mackerras 47111ee7e99SAnton Blanchard#ifdef CONFIG_RELOCATABLE 47254622f10SMohan Kumar M/* 47354622f10SMohan Kumar M * Check if the kernel has to be running as relocatable kernel based on the 4748b8b0cc1SMilton Miller * variable __run_at_load, if it is set the kernel is treated as relocatable 47554622f10SMohan Kumar M * kernel, otherwise it will be moved to PHYSICAL_START 47654622f10SMohan Kumar M */ 4778b8b0cc1SMilton Miller lwz r7,__run_at_load-_stext(r26) 4788b8b0cc1SMilton Miller cmplwi cr0,r7,1 47954622f10SMohan Kumar M bne 3f 48054622f10SMohan Kumar M 481c1fb6816SMichael Neuling /* just copy interrupts */ 482c1fb6816SMichael Neuling LOAD_REG_IMMEDIATE(r5, __end_interrupts - _stext) 48354622f10SMohan Kumar M b 5f 48454622f10SMohan Kumar M3: 48554622f10SMohan Kumar M#endif 48654622f10SMohan Kumar M lis r5,(copy_to_here - _stext)@ha 48754622f10SMohan Kumar M addi r5,r5,(copy_to_here - _stext)@l /* # bytes of memory to copy */ 48854622f10SMohan Kumar M 489b1576fecSAnton Blanchard bl copy_and_flush /* copy the first n bytes */ 49014cf11afSPaul Mackerras /* this includes the code being */ 49114cf11afSPaul Mackerras /* executed here. */ 492e31aa453SPaul Mackerras addis r8,r3,(4f - _stext)@ha /* Jump to the copy of this code */ 493cc7efbf9SAnton Blanchard addi r12,r8,(4f - _stext)@l /* that we just made */ 494cc7efbf9SAnton Blanchard mtctr r12 49514cf11afSPaul Mackerras bctr 49614cf11afSPaul Mackerras 497286e4f90SAnton Blanchard.balign 8 49854622f10SMohan Kumar Mp_end: .llong _end - _stext 49954622f10SMohan Kumar M 500e31aa453SPaul Mackerras4: /* Now copy the rest of the kernel up to _end */ 501e31aa453SPaul Mackerras addis r5,r26,(p_end - _stext)@ha 502e31aa453SPaul Mackerras ld r5,(p_end - _stext)@l(r5) /* get _end */ 503b1576fecSAnton Blanchard5: bl copy_and_flush /* copy the rest */ 504e31aa453SPaul Mackerras 505b1576fecSAnton Blanchard9: b start_here_multiplatform 506e31aa453SPaul Mackerras 50714cf11afSPaul Mackerras/* 50814cf11afSPaul Mackerras * Copy routine used to copy the kernel to start at physical address 0 50914cf11afSPaul Mackerras * and flush and invalidate the caches as needed. 51014cf11afSPaul Mackerras * r3 = dest addr, r4 = source addr, r5 = copy limit, r6 = start offset 51114cf11afSPaul Mackerras * on exit, r3, r4, r5 are unchanged, r6 is updated to be >= r5. 51214cf11afSPaul Mackerras * 51314cf11afSPaul Mackerras * Note: this routine *only* clobbers r0, r6 and lr 51414cf11afSPaul Mackerras */ 51514cf11afSPaul Mackerras_GLOBAL(copy_and_flush) 51614cf11afSPaul Mackerras addi r5,r5,-8 51714cf11afSPaul Mackerras addi r6,r6,-8 5185a2fe38dSOlof Johansson4: li r0,8 /* Use the smallest common */ 51914cf11afSPaul Mackerras /* denominator cache line */ 52014cf11afSPaul Mackerras /* size. This results in */ 52114cf11afSPaul Mackerras /* extra cache line flushes */ 52214cf11afSPaul Mackerras /* but operation is correct. */ 52314cf11afSPaul Mackerras /* Can't get cache line size */ 52414cf11afSPaul Mackerras /* from NACA as it is being */ 52514cf11afSPaul Mackerras /* moved too. */ 52614cf11afSPaul Mackerras 52714cf11afSPaul Mackerras mtctr r0 /* put # words/line in ctr */ 52814cf11afSPaul Mackerras3: addi r6,r6,8 /* copy a cache line */ 52914cf11afSPaul Mackerras ldx r0,r6,r4 53014cf11afSPaul Mackerras stdx r0,r6,r3 53114cf11afSPaul Mackerras bdnz 3b 53214cf11afSPaul Mackerras dcbst r6,r3 /* write it to memory */ 53314cf11afSPaul Mackerras sync 53414cf11afSPaul Mackerras icbi r6,r3 /* flush the icache line */ 53514cf11afSPaul Mackerras cmpld 0,r6,r5 53614cf11afSPaul Mackerras blt 4b 53714cf11afSPaul Mackerras sync 53814cf11afSPaul Mackerras addi r5,r5,8 53914cf11afSPaul Mackerras addi r6,r6,8 54029ce3c50SMichael Neuling isync 54114cf11afSPaul Mackerras blr 54214cf11afSPaul Mackerras 54314cf11afSPaul Mackerras.align 8 54414cf11afSPaul Mackerrascopy_to_here: 54514cf11afSPaul Mackerras 54614cf11afSPaul Mackerras#ifdef CONFIG_SMP 54714cf11afSPaul Mackerras#ifdef CONFIG_PPC_PMAC 54814cf11afSPaul Mackerras/* 54914cf11afSPaul Mackerras * On PowerMac, secondary processors starts from the reset vector, which 55014cf11afSPaul Mackerras * is temporarily turned into a call to one of the functions below. 55114cf11afSPaul Mackerras */ 55214cf11afSPaul Mackerras .section ".text"; 55314cf11afSPaul Mackerras .align 2 ; 55414cf11afSPaul Mackerras 55535499c01SPaul Mackerras .globl __secondary_start_pmac_0 55635499c01SPaul Mackerras__secondary_start_pmac_0: 55735499c01SPaul Mackerras /* NB the entries for cpus 0, 1, 2 must each occupy 8 bytes. */ 55835499c01SPaul Mackerras li r24,0 55935499c01SPaul Mackerras b 1f 56014cf11afSPaul Mackerras li r24,1 56135499c01SPaul Mackerras b 1f 56214cf11afSPaul Mackerras li r24,2 56335499c01SPaul Mackerras b 1f 56414cf11afSPaul Mackerras li r24,3 56535499c01SPaul Mackerras1: 56614cf11afSPaul Mackerras 56714cf11afSPaul Mackerras_GLOBAL(pmac_secondary_start) 56814cf11afSPaul Mackerras /* turn on 64-bit mode */ 569b1576fecSAnton Blanchard bl enable_64b_mode 57014cf11afSPaul Mackerras 571c478b581SBenjamin Herrenschmidt li r0,0 572c478b581SBenjamin Herrenschmidt mfspr r3,SPRN_HID4 573c478b581SBenjamin Herrenschmidt rldimi r3,r0,40,23 /* clear bit 23 (rm_ci) */ 574c478b581SBenjamin Herrenschmidt sync 575c478b581SBenjamin Herrenschmidt mtspr SPRN_HID4,r3 576c478b581SBenjamin Herrenschmidt isync 577c478b581SBenjamin Herrenschmidt sync 578c478b581SBenjamin Herrenschmidt slbia 579c478b581SBenjamin Herrenschmidt 580e31aa453SPaul Mackerras /* get TOC pointer (real address) */ 581b1576fecSAnton Blanchard bl relative_toc 5821fbe9cf2SAnton Blanchard tovirt(r2,r2) 583e31aa453SPaul Mackerras 58414cf11afSPaul Mackerras /* Copy some CPU settings from CPU 0 */ 585b1576fecSAnton Blanchard bl __restore_cpu_ppc970 58614cf11afSPaul Mackerras 58714cf11afSPaul Mackerras /* pSeries do that early though I don't think we really need it */ 58814cf11afSPaul Mackerras mfmsr r3 58914cf11afSPaul Mackerras ori r3,r3,MSR_RI 59014cf11afSPaul Mackerras mtmsrd r3 /* RI on */ 59114cf11afSPaul Mackerras 59214cf11afSPaul Mackerras /* Set up a paca value for this processor. */ 5931426d5a3SMichael Ellerman LOAD_REG_ADDR(r4,paca) /* Load paca pointer */ 5941426d5a3SMichael Ellerman ld r4,0(r4) /* Get base vaddr of paca array */ 59514cf11afSPaul Mackerras mulli r13,r24,PACA_SIZE /* Calculate vaddr of right paca */ 59614cf11afSPaul Mackerras add r13,r13,r4 /* for this processor. */ 5972dd60d79SBenjamin Herrenschmidt SET_PACA(r13) /* Save vaddr of paca in an SPRG*/ 59814cf11afSPaul Mackerras 59962cc67b9SBenjamin Herrenschmidt /* Mark interrupts soft and hard disabled (they might be enabled 60062cc67b9SBenjamin Herrenschmidt * in the PACA when doing hotplug) 60162cc67b9SBenjamin Herrenschmidt */ 60262cc67b9SBenjamin Herrenschmidt li r0,0 60362cc67b9SBenjamin Herrenschmidt stb r0,PACASOFTIRQEN(r13) 6047230c564SBenjamin Herrenschmidt li r0,PACA_IRQ_HARD_DIS 6057230c564SBenjamin Herrenschmidt stb r0,PACAIRQHAPPENED(r13) 60662cc67b9SBenjamin Herrenschmidt 60714cf11afSPaul Mackerras /* Create a temp kernel stack for use before relocation is on. */ 60814cf11afSPaul Mackerras ld r1,PACAEMERGSP(r13) 60914cf11afSPaul Mackerras subi r1,r1,STACK_FRAME_OVERHEAD 61014cf11afSPaul Mackerras 611c705677eSStephen Rothwell b __secondary_start 61214cf11afSPaul Mackerras 61314cf11afSPaul Mackerras#endif /* CONFIG_PPC_PMAC */ 61414cf11afSPaul Mackerras 61514cf11afSPaul Mackerras/* 61614cf11afSPaul Mackerras * This function is called after the master CPU has released the 61714cf11afSPaul Mackerras * secondary processors. The execution environment is relocation off. 61814cf11afSPaul Mackerras * The paca for this processor has the following fields initialized at 61914cf11afSPaul Mackerras * this point: 62014cf11afSPaul Mackerras * 1. Processor number 62114cf11afSPaul Mackerras * 2. Segment table pointer (virtual address) 62214cf11afSPaul Mackerras * On entry the following are set: 6234f8cf36fSBenjamin Herrenschmidt * r1 = stack pointer (real addr of temp stack) 62414cf11afSPaul Mackerras * r24 = cpu# (in Linux terms) 62514cf11afSPaul Mackerras * r13 = paca virtual address 626ee43eb78SBenjamin Herrenschmidt * SPRG_PACA = paca virtual address 62714cf11afSPaul Mackerras */ 6282d27cfd3SBenjamin Herrenschmidt .section ".text"; 6292d27cfd3SBenjamin Herrenschmidt .align 2 ; 6302d27cfd3SBenjamin Herrenschmidt 631fc68e869SStephen Rothwell .globl __secondary_start 632c705677eSStephen Rothwell__secondary_start: 633799d6046SPaul Mackerras /* Set thread priority to MEDIUM */ 634799d6046SPaul Mackerras HMT_MEDIUM 63514cf11afSPaul Mackerras 6364f8cf36fSBenjamin Herrenschmidt /* Initialize the kernel stack */ 637e58c3495SDavid Gibson LOAD_REG_ADDR(r3, current_set) 63814cf11afSPaul Mackerras sldi r28,r24,3 /* get current_set[cpu#] */ 63954a83404SMichael Neuling ldx r14,r3,r28 64054a83404SMichael Neuling addi r14,r14,THREAD_SIZE-STACK_FRAME_OVERHEAD 64154a83404SMichael Neuling std r14,PACAKSAVE(r13) 64214cf11afSPaul Mackerras 643f761622eSMatt Evans /* Do early setup for that CPU (stab, slb, hash table pointer) */ 644b1576fecSAnton Blanchard bl early_setup_secondary 645f761622eSMatt Evans 64654a83404SMichael Neuling /* 64754a83404SMichael Neuling * setup the new stack pointer, but *don't* use this until 64854a83404SMichael Neuling * translation is on. 64954a83404SMichael Neuling */ 65054a83404SMichael Neuling mr r1, r14 65154a83404SMichael Neuling 652799d6046SPaul Mackerras /* Clear backchain so we get nice backtraces */ 65314cf11afSPaul Mackerras li r7,0 65414cf11afSPaul Mackerras mtlr r7 65514cf11afSPaul Mackerras 6567230c564SBenjamin Herrenschmidt /* Mark interrupts soft and hard disabled (they might be enabled 6577230c564SBenjamin Herrenschmidt * in the PACA when doing hotplug) 6587230c564SBenjamin Herrenschmidt */ 6594f8cf36fSBenjamin Herrenschmidt stb r7,PACASOFTIRQEN(r13) 6607230c564SBenjamin Herrenschmidt li r0,PACA_IRQ_HARD_DIS 6617230c564SBenjamin Herrenschmidt stb r0,PACAIRQHAPPENED(r13) 6624f8cf36fSBenjamin Herrenschmidt 66314cf11afSPaul Mackerras /* enable MMU and jump to start_secondary */ 664ad0289e4SAnton Blanchard LOAD_REG_ADDR(r3, start_secondary_prolog) 665e58c3495SDavid Gibson LOAD_REG_IMMEDIATE(r4, MSR_KERNEL) 666d04c56f7SPaul Mackerras 667b5bbeb23SPaul Mackerras mtspr SPRN_SRR0,r3 668b5bbeb23SPaul Mackerras mtspr SPRN_SRR1,r4 6692d27cfd3SBenjamin Herrenschmidt RFI 67014cf11afSPaul Mackerras b . /* prevent speculative execution */ 67114cf11afSPaul Mackerras 67214cf11afSPaul Mackerras/* 67314cf11afSPaul Mackerras * Running with relocation on at this point. All we want to do is 674e31aa453SPaul Mackerras * zero the stack back-chain pointer and get the TOC virtual address 675e31aa453SPaul Mackerras * before going into C code. 67614cf11afSPaul Mackerras */ 677ad0289e4SAnton Blanchardstart_secondary_prolog: 678e31aa453SPaul Mackerras ld r2,PACATOC(r13) 67914cf11afSPaul Mackerras li r3,0 68014cf11afSPaul Mackerras std r3,0(r1) /* Zero the stack frame pointer */ 681b1576fecSAnton Blanchard bl start_secondary 682799d6046SPaul Mackerras b . 6838dbce53cSVaidyanathan Srinivasan/* 6848dbce53cSVaidyanathan Srinivasan * Reset stack pointer and call start_secondary 6858dbce53cSVaidyanathan Srinivasan * to continue with online operation when woken up 6868dbce53cSVaidyanathan Srinivasan * from cede in cpu offline. 6878dbce53cSVaidyanathan Srinivasan */ 6888dbce53cSVaidyanathan Srinivasan_GLOBAL(start_secondary_resume) 6898dbce53cSVaidyanathan Srinivasan ld r1,PACAKSAVE(r13) /* Reload kernel stack pointer */ 6908dbce53cSVaidyanathan Srinivasan li r3,0 6918dbce53cSVaidyanathan Srinivasan std r3,0(r1) /* Zero the stack frame pointer */ 692b1576fecSAnton Blanchard bl start_secondary 6938dbce53cSVaidyanathan Srinivasan b . 69414cf11afSPaul Mackerras#endif 69514cf11afSPaul Mackerras 69614cf11afSPaul Mackerras/* 69714cf11afSPaul Mackerras * This subroutine clobbers r11 and r12 69814cf11afSPaul Mackerras */ 6996a3bab90SAnton Blanchardenable_64b_mode: 70014cf11afSPaul Mackerras mfmsr r11 /* grab the current MSR */ 7012d27cfd3SBenjamin Herrenschmidt#ifdef CONFIG_PPC_BOOK3E 7022d27cfd3SBenjamin Herrenschmidt oris r11,r11,0x8000 /* CM bit set, we'll set ICM later */ 7032d27cfd3SBenjamin Herrenschmidt mtmsr r11 7042d27cfd3SBenjamin Herrenschmidt#else /* CONFIG_PPC_BOOK3E */ 7059f0b0793SMichael Ellerman li r12,(MSR_64BIT | MSR_ISF)@highest 706e31aa453SPaul Mackerras sldi r12,r12,48 70714cf11afSPaul Mackerras or r11,r11,r12 70814cf11afSPaul Mackerras mtmsrd r11 70914cf11afSPaul Mackerras isync 7102d27cfd3SBenjamin Herrenschmidt#endif 71114cf11afSPaul Mackerras blr 71214cf11afSPaul Mackerras 71314cf11afSPaul Mackerras/* 714e31aa453SPaul Mackerras * This puts the TOC pointer into r2, offset by 0x8000 (as expected 715e31aa453SPaul Mackerras * by the toolchain). It computes the correct value for wherever we 716e31aa453SPaul Mackerras * are running at the moment, using position-independent code. 7171fbe9cf2SAnton Blanchard * 7181fbe9cf2SAnton Blanchard * Note: The compiler constructs pointers using offsets from the 7191fbe9cf2SAnton Blanchard * TOC in -mcmodel=medium mode. After we relocate to 0 but before 7201fbe9cf2SAnton Blanchard * the MMU is on we need our TOC to be a virtual address otherwise 7211fbe9cf2SAnton Blanchard * these pointers will be real addresses which may get stored and 7221fbe9cf2SAnton Blanchard * accessed later with the MMU on. We use tovirt() at the call 7231fbe9cf2SAnton Blanchard * sites to handle this. 724e31aa453SPaul Mackerras */ 725e31aa453SPaul Mackerras_GLOBAL(relative_toc) 726e31aa453SPaul Mackerras mflr r0 727e31aa453SPaul Mackerras bcl 20,31,$+4 728e550592eSBenjamin Herrenschmidt0: mflr r11 729e550592eSBenjamin Herrenschmidt ld r2,(p_toc - 0b)(r11) 730e550592eSBenjamin Herrenschmidt add r2,r2,r11 731e31aa453SPaul Mackerras mtlr r0 732e31aa453SPaul Mackerras blr 733e31aa453SPaul Mackerras 7345b63fee1SAnton Blanchard.balign 8 735e31aa453SPaul Mackerrasp_toc: .llong __toc_start + 0x8000 - 0b 736e31aa453SPaul Mackerras 737e31aa453SPaul Mackerras/* 73814cf11afSPaul Mackerras * This is where the main kernel code starts. 73914cf11afSPaul Mackerras */ 7406a3bab90SAnton Blanchardstart_here_multiplatform: 7411fbe9cf2SAnton Blanchard /* set up the TOC */ 742b1576fecSAnton Blanchard bl relative_toc 7431fbe9cf2SAnton Blanchard tovirt(r2,r2) 74414cf11afSPaul Mackerras 74514cf11afSPaul Mackerras /* Clear out the BSS. It may have been done in prom_init, 74614cf11afSPaul Mackerras * already but that's irrelevant since prom_init will soon 74714cf11afSPaul Mackerras * be detached from the kernel completely. Besides, we need 74814cf11afSPaul Mackerras * to clear it now for kexec-style entry. 74914cf11afSPaul Mackerras */ 750e31aa453SPaul Mackerras LOAD_REG_ADDR(r11,__bss_stop) 751e31aa453SPaul Mackerras LOAD_REG_ADDR(r8,__bss_start) 75214cf11afSPaul Mackerras sub r11,r11,r8 /* bss size */ 75314cf11afSPaul Mackerras addi r11,r11,7 /* round up to an even double word */ 754e31aa453SPaul Mackerras srdi. r11,r11,3 /* shift right by 3 */ 75514cf11afSPaul Mackerras beq 4f 75614cf11afSPaul Mackerras addi r8,r8,-8 75714cf11afSPaul Mackerras li r0,0 75814cf11afSPaul Mackerras mtctr r11 /* zero this many doublewords */ 75914cf11afSPaul Mackerras3: stdu r0,8(r8) 76014cf11afSPaul Mackerras bdnz 3b 76114cf11afSPaul Mackerras4: 76214cf11afSPaul Mackerras 763daea1175SBenjamin Herrenschmidt#ifdef CONFIG_PPC_EARLY_DEBUG_OPAL 764daea1175SBenjamin Herrenschmidt /* Setup OPAL entry */ 765ab7f961aSBenjamin Herrenschmidt LOAD_REG_ADDR(r11, opal) 766daea1175SBenjamin Herrenschmidt std r28,0(r11); 767daea1175SBenjamin Herrenschmidt std r29,8(r11); 768daea1175SBenjamin Herrenschmidt#endif 769daea1175SBenjamin Herrenschmidt 7702d27cfd3SBenjamin Herrenschmidt#ifndef CONFIG_PPC_BOOK3E 77114cf11afSPaul Mackerras mfmsr r6 77214cf11afSPaul Mackerras ori r6,r6,MSR_RI 77314cf11afSPaul Mackerras mtmsrd r6 /* RI on */ 7742d27cfd3SBenjamin Herrenschmidt#endif 77514cf11afSPaul Mackerras 776549e8152SPaul Mackerras#ifdef CONFIG_RELOCATABLE 777549e8152SPaul Mackerras /* Save the physical address we're running at in kernstart_addr */ 778549e8152SPaul Mackerras LOAD_REG_ADDR(r4, kernstart_addr) 779549e8152SPaul Mackerras clrldi r0,r25,2 780549e8152SPaul Mackerras std r0,0(r4) 781549e8152SPaul Mackerras#endif 782549e8152SPaul Mackerras 783e31aa453SPaul Mackerras /* The following gets the stack set up with the regs */ 78414cf11afSPaul Mackerras /* pointing to the real addr of the kernel stack. This is */ 78514cf11afSPaul Mackerras /* all done to support the C function call below which sets */ 78614cf11afSPaul Mackerras /* up the htab. This is done because we have relocated the */ 78714cf11afSPaul Mackerras /* kernel but are still running in real mode. */ 78814cf11afSPaul Mackerras 789e31aa453SPaul Mackerras LOAD_REG_ADDR(r3,init_thread_union) 79014cf11afSPaul Mackerras 791e31aa453SPaul Mackerras /* set up a stack pointer */ 79214cf11afSPaul Mackerras addi r1,r3,THREAD_SIZE 79314cf11afSPaul Mackerras li r0,0 79414cf11afSPaul Mackerras stdu r0,-STACK_FRAME_OVERHEAD(r1) 79514cf11afSPaul Mackerras 79614cf11afSPaul Mackerras /* Do very early kernel initializations, including initial hash table, 79714cf11afSPaul Mackerras * stab and slb setup before we turn on relocation. */ 79814cf11afSPaul Mackerras 79914cf11afSPaul Mackerras /* Restore parameters passed from prom_init/kexec */ 80014cf11afSPaul Mackerras mr r3,r31 801b1576fecSAnton Blanchard bl early_setup /* also sets r13 and SPRG_PACA */ 80214cf11afSPaul Mackerras 803ad0289e4SAnton Blanchard LOAD_REG_ADDR(r3, start_here_common) 804e31aa453SPaul Mackerras ld r4,PACAKMSR(r13) 805b5bbeb23SPaul Mackerras mtspr SPRN_SRR0,r3 806b5bbeb23SPaul Mackerras mtspr SPRN_SRR1,r4 8072d27cfd3SBenjamin Herrenschmidt RFI 80814cf11afSPaul Mackerras b . /* prevent speculative execution */ 80914cf11afSPaul Mackerras 81014cf11afSPaul Mackerras /* This is where all platforms converge execution */ 811ad0289e4SAnton Blanchard 812ad0289e4SAnton Blanchardstart_here_common: 81314cf11afSPaul Mackerras /* relocation is on at this point */ 81414cf11afSPaul Mackerras std r1,PACAKSAVE(r13) 81514cf11afSPaul Mackerras 816e31aa453SPaul Mackerras /* Load the TOC (virtual address) */ 817e31aa453SPaul Mackerras ld r2,PACATOC(r13) 818e31aa453SPaul Mackerras 8197230c564SBenjamin Herrenschmidt /* Do more system initializations in virtual mode */ 820b1576fecSAnton Blanchard bl setup_system 82114cf11afSPaul Mackerras 8227230c564SBenjamin Herrenschmidt /* Mark interrupts soft and hard disabled (they might be enabled 8237230c564SBenjamin Herrenschmidt * in the PACA when doing hotplug) 8247230c564SBenjamin Herrenschmidt */ 8257230c564SBenjamin Herrenschmidt li r0,0 8267230c564SBenjamin Herrenschmidt stb r0,PACASOFTIRQEN(r13) 8277230c564SBenjamin Herrenschmidt li r0,PACA_IRQ_HARD_DIS 8287230c564SBenjamin Herrenschmidt stb r0,PACAIRQHAPPENED(r13) 82914cf11afSPaul Mackerras 8307230c564SBenjamin Herrenschmidt /* Generic kernel entry */ 831b1576fecSAnton Blanchard bl start_kernel 83214cf11afSPaul Mackerras 833f1870f77SAnton Blanchard /* Not reached */ 834f1870f77SAnton Blanchard BUG_OPCODE 83514cf11afSPaul Mackerras 83614cf11afSPaul Mackerras/* 83714cf11afSPaul Mackerras * We put a few things here that have to be page-aligned. 83814cf11afSPaul Mackerras * This stuff goes at the beginning of the bss, which is page-aligned. 83914cf11afSPaul Mackerras */ 84014cf11afSPaul Mackerras .section ".bss" 84114cf11afSPaul Mackerras 84214cf11afSPaul Mackerras .align PAGE_SHIFT 84314cf11afSPaul Mackerras 84414cf11afSPaul Mackerras .globl empty_zero_page 84514cf11afSPaul Mackerrasempty_zero_page: 84614cf11afSPaul Mackerras .space PAGE_SIZE 84714cf11afSPaul Mackerras 84814cf11afSPaul Mackerras .globl swapper_pg_dir 84914cf11afSPaul Mackerrasswapper_pg_dir: 850ee7a76daSStephen Rothwell .space PGD_TABLE_SIZE 851