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> 35c43a55ffSKelly Daly#include <asm/iseries/lpar_map.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> 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 54*27f44888SBenjamin Herrenschmidt * -or- For OPAL entry: 55*27f44888SBenjamin Herrenschmidt * 1. The MMU is off, processor in HV mode, primary CPU enters at 0 56*27f44888SBenjamin Herrenschmidt * with device-tree in gpr3 57*27f44888SBenjamin Herrenschmidt * 2. Secondary processors enter at 0x60 with PIR in gpr3 5814cf11afSPaul Mackerras * 5914cf11afSPaul Mackerras * For iSeries: 6014cf11afSPaul Mackerras * 1. The MMU is on (as it always is for iSeries) 6114cf11afSPaul Mackerras * 2. The kernel is entered at system_reset_iSeries 620ebc4cdaSBenjamin Herrenschmidt * 630ebc4cdaSBenjamin Herrenschmidt * For Book3E processors: 640ebc4cdaSBenjamin Herrenschmidt * 1. The MMU is on running in AS0 in a state defined in ePAPR 650ebc4cdaSBenjamin Herrenschmidt * 2. The kernel is entered at __start 6614cf11afSPaul Mackerras */ 6714cf11afSPaul Mackerras 6814cf11afSPaul Mackerras .text 6914cf11afSPaul Mackerras .globl _stext 7014cf11afSPaul Mackerras_stext: 7114cf11afSPaul Mackerras_GLOBAL(__start) 7214cf11afSPaul Mackerras /* NOP this out unconditionally */ 7314cf11afSPaul MackerrasBEGIN_FTR_SECTION 7414cf11afSPaul Mackerras b .__start_initialization_multiplatform 7514cf11afSPaul MackerrasEND_FTR_SECTION(0, 1) 7614cf11afSPaul Mackerras 7714cf11afSPaul Mackerras /* Catch branch to 0 in real mode */ 7814cf11afSPaul Mackerras trap 7914cf11afSPaul Mackerras 801f6a93e4SPaul Mackerras /* Secondary processors spin on this value until it becomes nonzero. 811f6a93e4SPaul Mackerras * When it does it contains the real address of the descriptor 821f6a93e4SPaul Mackerras * of the function that the cpu should jump to to continue 831f6a93e4SPaul Mackerras * initialization. 841f6a93e4SPaul Mackerras */ 8514cf11afSPaul Mackerras .globl __secondary_hold_spinloop 8614cf11afSPaul Mackerras__secondary_hold_spinloop: 8714cf11afSPaul Mackerras .llong 0x0 8814cf11afSPaul Mackerras 8914cf11afSPaul Mackerras /* Secondary processors write this value with their cpu # */ 9014cf11afSPaul Mackerras /* after they enter the spin loop immediately below. */ 9114cf11afSPaul Mackerras .globl __secondary_hold_acknowledge 9214cf11afSPaul Mackerras__secondary_hold_acknowledge: 9314cf11afSPaul Mackerras .llong 0x0 9414cf11afSPaul Mackerras 951dce0e30SMichael Ellerman#ifdef CONFIG_PPC_ISERIES 961dce0e30SMichael Ellerman /* 971dce0e30SMichael Ellerman * At offset 0x20, there is a pointer to iSeries LPAR data. 981dce0e30SMichael Ellerman * This is required by the hypervisor 991dce0e30SMichael Ellerman */ 1001dce0e30SMichael Ellerman . = 0x20 1011dce0e30SMichael Ellerman .llong hvReleaseData-KERNELBASE 1021dce0e30SMichael Ellerman#endif /* CONFIG_PPC_ISERIES */ 1031dce0e30SMichael Ellerman 104928a3197SSonny Rao#ifdef CONFIG_RELOCATABLE 1058b8b0cc1SMilton Miller /* This flag is set to 1 by a loader if the kernel should run 1068b8b0cc1SMilton Miller * at the loaded address instead of the linked address. This 1078b8b0cc1SMilton Miller * is used by kexec-tools to keep the the kdump kernel in the 1088b8b0cc1SMilton Miller * crash_kernel region. The loader is responsible for 1098b8b0cc1SMilton Miller * observing the alignment requirement. 1108b8b0cc1SMilton Miller */ 1118b8b0cc1SMilton Miller /* Do not move this variable as kexec-tools knows about it. */ 1128b8b0cc1SMilton Miller . = 0x5c 1138b8b0cc1SMilton Miller .globl __run_at_load 1148b8b0cc1SMilton Miller__run_at_load: 1158b8b0cc1SMilton Miller .long 0x72756e30 /* "run0" -- relocate to 0 by default */ 1168b8b0cc1SMilton Miller#endif 1178b8b0cc1SMilton Miller 11814cf11afSPaul Mackerras . = 0x60 11914cf11afSPaul Mackerras/* 12075423b7bSGeoff Levand * The following code is used to hold secondary processors 12175423b7bSGeoff Levand * in a spin loop after they have entered the kernel, but 12214cf11afSPaul Mackerras * before the bulk of the kernel has been relocated. This code 12314cf11afSPaul Mackerras * is relocated to physical address 0x60 before prom_init is run. 12414cf11afSPaul Mackerras * All of it must fit below the first exception vector at 0x100. 1251f6a93e4SPaul Mackerras * Use .globl here not _GLOBAL because we want __secondary_hold 1261f6a93e4SPaul Mackerras * to be the actual text address, not a descriptor. 12714cf11afSPaul Mackerras */ 1281f6a93e4SPaul Mackerras .globl __secondary_hold 1291f6a93e4SPaul Mackerras__secondary_hold: 1302d27cfd3SBenjamin Herrenschmidt#ifndef CONFIG_PPC_BOOK3E 13114cf11afSPaul Mackerras mfmsr r24 13214cf11afSPaul Mackerras ori r24,r24,MSR_RI 13314cf11afSPaul Mackerras mtmsrd r24 /* RI on */ 1342d27cfd3SBenjamin Herrenschmidt#endif 135f1870f77SAnton Blanchard /* Grab our physical cpu number */ 13614cf11afSPaul Mackerras mr r24,r3 13714cf11afSPaul Mackerras 13814cf11afSPaul Mackerras /* Tell the master cpu we're here */ 13914cf11afSPaul Mackerras /* Relocation is off & we are located at an address less */ 14014cf11afSPaul Mackerras /* than 0x100, so only need to grab low order offset. */ 141e31aa453SPaul Mackerras std r24,__secondary_hold_acknowledge-_stext(0) 14214cf11afSPaul Mackerras sync 14314cf11afSPaul Mackerras 14414cf11afSPaul Mackerras /* All secondary cpus wait here until told to start. */ 145e31aa453SPaul Mackerras100: ld r4,__secondary_hold_spinloop-_stext(0) 1461f6a93e4SPaul Mackerras cmpdi 0,r4,0 1471f6a93e4SPaul Mackerras beq 100b 14814cf11afSPaul Mackerras 149f1870f77SAnton Blanchard#if defined(CONFIG_SMP) || defined(CONFIG_KEXEC) 1501f6a93e4SPaul Mackerras ld r4,0(r4) /* deref function descriptor */ 151758438a7SMichael Ellerman mtctr r4 15214cf11afSPaul Mackerras mr r3,r24 1532d27cfd3SBenjamin Herrenschmidt li r4,0 154dd797738SBenjamin Herrenschmidt /* Make sure that patched code is visible */ 155dd797738SBenjamin Herrenschmidt isync 156758438a7SMichael Ellerman bctr 15714cf11afSPaul Mackerras#else 15814cf11afSPaul Mackerras BUG_OPCODE 15914cf11afSPaul Mackerras#endif 16014cf11afSPaul Mackerras 16114cf11afSPaul Mackerras/* This value is used to mark exception frames on the stack. */ 16214cf11afSPaul Mackerras .section ".toc","aw" 16314cf11afSPaul Mackerrasexception_marker: 16414cf11afSPaul Mackerras .tc ID_72656773_68657265[TC],0x7265677368657265 16514cf11afSPaul Mackerras .text 16614cf11afSPaul Mackerras 16714cf11afSPaul Mackerras/* 1680ebc4cdaSBenjamin Herrenschmidt * On server, we include the exception vectors code here as it 1690ebc4cdaSBenjamin Herrenschmidt * relies on absolute addressing which is only possible within 1700ebc4cdaSBenjamin Herrenschmidt * this compilation unit 17114cf11afSPaul Mackerras */ 1720ebc4cdaSBenjamin Herrenschmidt#ifdef CONFIG_PPC_BOOK3S 1730ebc4cdaSBenjamin Herrenschmidt#include "exceptions-64s.S" 1741f6a93e4SPaul Mackerras#endif 17514cf11afSPaul Mackerras 1762d27cfd3SBenjamin Herrenschmidt_GLOBAL(generic_secondary_thread_init) 17714cf11afSPaul Mackerras mr r24,r3 17814cf11afSPaul Mackerras 17914cf11afSPaul Mackerras /* turn on 64-bit mode */ 18014cf11afSPaul Mackerras bl .enable_64b_mode 18114cf11afSPaul Mackerras 1822d27cfd3SBenjamin Herrenschmidt /* get a valid TOC pointer, wherever we're mapped at */ 183e31aa453SPaul Mackerras bl .relative_toc 184e31aa453SPaul Mackerras 1852d27cfd3SBenjamin Herrenschmidt#ifdef CONFIG_PPC_BOOK3E 1862d27cfd3SBenjamin Herrenschmidt /* Book3E initialization */ 1872d27cfd3SBenjamin Herrenschmidt mr r3,r24 1882d27cfd3SBenjamin Herrenschmidt bl .book3e_secondary_thread_init 1892d27cfd3SBenjamin Herrenschmidt#endif 1902d27cfd3SBenjamin Herrenschmidt b generic_secondary_common_init 1912d27cfd3SBenjamin Herrenschmidt 1922d27cfd3SBenjamin Herrenschmidt/* 1932d27cfd3SBenjamin Herrenschmidt * On pSeries and most other platforms, secondary processors spin 1942d27cfd3SBenjamin Herrenschmidt * in the following code. 1952d27cfd3SBenjamin Herrenschmidt * At entry, r3 = this processor's number (physical cpu id) 1962d27cfd3SBenjamin Herrenschmidt * 1972d27cfd3SBenjamin Herrenschmidt * On Book3E, r4 = 1 to indicate that the initial TLB entry for 1982d27cfd3SBenjamin Herrenschmidt * this core already exists (setup via some other mechanism such 1992d27cfd3SBenjamin Herrenschmidt * as SCOM before entry). 2002d27cfd3SBenjamin Herrenschmidt */ 2012d27cfd3SBenjamin Herrenschmidt_GLOBAL(generic_secondary_smp_init) 2022d27cfd3SBenjamin Herrenschmidt mr r24,r3 2032d27cfd3SBenjamin Herrenschmidt mr r25,r4 2042d27cfd3SBenjamin Herrenschmidt 2052d27cfd3SBenjamin Herrenschmidt /* turn on 64-bit mode */ 2062d27cfd3SBenjamin Herrenschmidt bl .enable_64b_mode 2072d27cfd3SBenjamin Herrenschmidt 2082d27cfd3SBenjamin Herrenschmidt /* get a valid TOC pointer, wherever we're mapped at */ 2092d27cfd3SBenjamin Herrenschmidt bl .relative_toc 2102d27cfd3SBenjamin Herrenschmidt 2112d27cfd3SBenjamin Herrenschmidt#ifdef CONFIG_PPC_BOOK3E 2122d27cfd3SBenjamin Herrenschmidt /* Book3E initialization */ 2132d27cfd3SBenjamin Herrenschmidt mr r3,r24 2142d27cfd3SBenjamin Herrenschmidt mr r4,r25 2152d27cfd3SBenjamin Herrenschmidt bl .book3e_secondary_core_init 2162d27cfd3SBenjamin Herrenschmidt#endif 2172d27cfd3SBenjamin Herrenschmidt 2182d27cfd3SBenjamin Herrenschmidtgeneric_secondary_common_init: 21914cf11afSPaul Mackerras /* Set up a paca value for this processor. Since we have the 22014cf11afSPaul Mackerras * physical cpu id in r24, we need to search the pacas to find 22114cf11afSPaul Mackerras * which logical id maps to our physical one. 22214cf11afSPaul Mackerras */ 2231426d5a3SMichael Ellerman LOAD_REG_ADDR(r13, paca) /* Load paca pointer */ 2241426d5a3SMichael Ellerman ld r13,0(r13) /* Get base vaddr of paca array */ 225768d18adSMilton Miller#ifndef CONFIG_SMP 226768d18adSMilton Miller addi r13,r13,PACA_SIZE /* know r13 if used accidentally */ 227768d18adSMilton Miller b .kexec_wait /* wait for next kernel if !SMP */ 228768d18adSMilton Miller#else 229768d18adSMilton Miller LOAD_REG_ADDR(r7, nr_cpu_ids) /* Load nr_cpu_ids address */ 230768d18adSMilton Miller lwz r7,0(r7) /* also the max paca allocated */ 23114cf11afSPaul Mackerras li r5,0 /* logical cpu id */ 23214cf11afSPaul Mackerras1: lhz r6,PACAHWCPUID(r13) /* Load HW procid from paca */ 23314cf11afSPaul Mackerras cmpw r6,r24 /* Compare to our id */ 23414cf11afSPaul Mackerras beq 2f 23514cf11afSPaul Mackerras addi r13,r13,PACA_SIZE /* Loop to next PACA on miss */ 23614cf11afSPaul Mackerras addi r5,r5,1 237768d18adSMilton Miller cmpw r5,r7 /* Check if more pacas exist */ 23814cf11afSPaul Mackerras blt 1b 23914cf11afSPaul Mackerras 24014cf11afSPaul Mackerras mr r3,r24 /* not found, copy phys to r3 */ 24114cf11afSPaul Mackerras b .kexec_wait /* next kernel might do better */ 24214cf11afSPaul Mackerras 2432dd60d79SBenjamin Herrenschmidt2: SET_PACA(r13) 2442d27cfd3SBenjamin Herrenschmidt#ifdef CONFIG_PPC_BOOK3E 2452d27cfd3SBenjamin Herrenschmidt addi r12,r13,PACA_EXTLB /* and TLB exc frame in another */ 2462d27cfd3SBenjamin Herrenschmidt mtspr SPRN_SPRG_TLB_EXFRAME,r12 2472d27cfd3SBenjamin Herrenschmidt#endif 2482d27cfd3SBenjamin Herrenschmidt 24914cf11afSPaul Mackerras /* From now on, r24 is expected to be logical cpuid */ 25014cf11afSPaul Mackerras mr r24,r5 251b6f6b98aSSonny Rao 252f39b7a55SOlof Johansson /* See if we need to call a cpu state restore handler */ 253e31aa453SPaul Mackerras LOAD_REG_ADDR(r23, cur_cpu_spec) 254f39b7a55SOlof Johansson ld r23,0(r23) 255f39b7a55SOlof Johansson ld r23,CPU_SPEC_RESTORE(r23) 256f39b7a55SOlof Johansson cmpdi 0,r23,0 2579d07bc84SBenjamin Herrenschmidt beq 3f 258f39b7a55SOlof Johansson ld r23,0(r23) 259f39b7a55SOlof Johansson mtctr r23 260f39b7a55SOlof Johansson bctrl 261f39b7a55SOlof Johansson 2627ac87abbSMatt Evans3: LOAD_REG_ADDR(r3, spinning_secondaries) /* Decrement spinning_secondaries */ 2639d07bc84SBenjamin Herrenschmidt lwarx r4,0,r3 2649d07bc84SBenjamin Herrenschmidt subi r4,r4,1 2659d07bc84SBenjamin Herrenschmidt stwcx. r4,0,r3 2669d07bc84SBenjamin Herrenschmidt bne 3b 2679d07bc84SBenjamin Herrenschmidt isync 2689d07bc84SBenjamin Herrenschmidt 2699d07bc84SBenjamin Herrenschmidt4: HMT_LOW 270ad0693eeSBenjamin Herrenschmidt lbz r23,PACAPROCSTART(r13) /* Test if this processor should */ 271ad0693eeSBenjamin Herrenschmidt /* start. */ 272ad0693eeSBenjamin Herrenschmidt cmpwi 0,r23,0 2739d07bc84SBenjamin Herrenschmidt beq 4b /* Loop until told to go */ 274ad0693eeSBenjamin Herrenschmidt 275ad0693eeSBenjamin Herrenschmidt sync /* order paca.run and cur_cpu_spec */ 2769d07bc84SBenjamin Herrenschmidt isync /* In case code patching happened */ 277ad0693eeSBenjamin Herrenschmidt 2789d07bc84SBenjamin Herrenschmidt /* Create a temp kernel stack for use before relocation is on. */ 27914cf11afSPaul Mackerras ld r1,PACAEMERGSP(r13) 28014cf11afSPaul Mackerras subi r1,r1,STACK_FRAME_OVERHEAD 28114cf11afSPaul Mackerras 282c705677eSStephen Rothwell b __secondary_start 283768d18adSMilton Miller#endif /* SMP */ 28414cf11afSPaul Mackerras 285e31aa453SPaul Mackerras/* 286e31aa453SPaul Mackerras * Turn the MMU off. 287e31aa453SPaul Mackerras * Assumes we're mapped EA == RA if the MMU is on. 288e31aa453SPaul Mackerras */ 2892d27cfd3SBenjamin Herrenschmidt#ifdef CONFIG_PPC_BOOK3S 29014cf11afSPaul Mackerras_STATIC(__mmu_off) 29114cf11afSPaul Mackerras mfmsr r3 29214cf11afSPaul Mackerras andi. r0,r3,MSR_IR|MSR_DR 29314cf11afSPaul Mackerras beqlr 294e31aa453SPaul Mackerras mflr r4 29514cf11afSPaul Mackerras andc r3,r3,r0 29614cf11afSPaul Mackerras mtspr SPRN_SRR0,r4 29714cf11afSPaul Mackerras mtspr SPRN_SRR1,r3 29814cf11afSPaul Mackerras sync 29914cf11afSPaul Mackerras rfid 30014cf11afSPaul Mackerras b . /* prevent speculative execution */ 3012d27cfd3SBenjamin Herrenschmidt#endif 30214cf11afSPaul Mackerras 30314cf11afSPaul Mackerras 30414cf11afSPaul Mackerras/* 30514cf11afSPaul Mackerras * Here is our main kernel entry point. We support currently 2 kind of entries 30614cf11afSPaul Mackerras * depending on the value of r5. 30714cf11afSPaul Mackerras * 30814cf11afSPaul Mackerras * r5 != NULL -> OF entry, we go to prom_init, "legacy" parameter content 30914cf11afSPaul Mackerras * in r3...r7 31014cf11afSPaul Mackerras * 31114cf11afSPaul Mackerras * r5 == NULL -> kexec style entry. r3 is a physical pointer to the 31214cf11afSPaul Mackerras * DT block, r4 is a physical pointer to the kernel itself 31314cf11afSPaul Mackerras * 31414cf11afSPaul Mackerras */ 31514cf11afSPaul Mackerras_GLOBAL(__start_initialization_multiplatform) 316e31aa453SPaul Mackerras /* Make sure we are running in 64 bits mode */ 317e31aa453SPaul Mackerras bl .enable_64b_mode 318e31aa453SPaul Mackerras 319e31aa453SPaul Mackerras /* Get TOC pointer (current runtime address) */ 320e31aa453SPaul Mackerras bl .relative_toc 321e31aa453SPaul Mackerras 322e31aa453SPaul Mackerras /* find out where we are now */ 323e31aa453SPaul Mackerras bcl 20,31,$+4 324e31aa453SPaul Mackerras0: mflr r26 /* r26 = runtime addr here */ 325e31aa453SPaul Mackerras addis r26,r26,(_stext - 0b)@ha 326e31aa453SPaul Mackerras addi r26,r26,(_stext - 0b)@l /* current runtime base addr */ 327e31aa453SPaul Mackerras 32814cf11afSPaul Mackerras /* 32914cf11afSPaul Mackerras * Are we booted from a PROM Of-type client-interface ? 33014cf11afSPaul Mackerras */ 33114cf11afSPaul Mackerras cmpldi cr0,r5,0 332939e60f6SStephen Rothwell beq 1f 333939e60f6SStephen Rothwell b .__boot_from_prom /* yes -> prom */ 334939e60f6SStephen Rothwell1: 33514cf11afSPaul Mackerras /* Save parameters */ 33614cf11afSPaul Mackerras mr r31,r3 33714cf11afSPaul Mackerras mr r30,r4 33814cf11afSPaul Mackerras 3392d27cfd3SBenjamin Herrenschmidt#ifdef CONFIG_PPC_BOOK3E 3402d27cfd3SBenjamin Herrenschmidt bl .start_initialization_book3e 3412d27cfd3SBenjamin Herrenschmidt b .__after_prom_start 3422d27cfd3SBenjamin Herrenschmidt#else 34314cf11afSPaul Mackerras /* Setup some critical 970 SPRs before switching MMU off */ 344f39b7a55SOlof Johansson mfspr r0,SPRN_PVR 345f39b7a55SOlof Johansson srwi r0,r0,16 346f39b7a55SOlof Johansson cmpwi r0,0x39 /* 970 */ 347f39b7a55SOlof Johansson beq 1f 348f39b7a55SOlof Johansson cmpwi r0,0x3c /* 970FX */ 349f39b7a55SOlof Johansson beq 1f 350f39b7a55SOlof Johansson cmpwi r0,0x44 /* 970MP */ 351190a24f5SOlof Johansson beq 1f 352190a24f5SOlof Johansson cmpwi r0,0x45 /* 970GX */ 353f39b7a55SOlof Johansson bne 2f 354f39b7a55SOlof Johansson1: bl .__cpu_preinit_ppc970 355f39b7a55SOlof Johansson2: 35614cf11afSPaul Mackerras 357e31aa453SPaul Mackerras /* Switch off MMU if not already off */ 35814cf11afSPaul Mackerras bl .__mmu_off 35914cf11afSPaul Mackerras b .__after_prom_start 3602d27cfd3SBenjamin Herrenschmidt#endif /* CONFIG_PPC_BOOK3E */ 36114cf11afSPaul Mackerras 362939e60f6SStephen Rothwell_INIT_STATIC(__boot_from_prom) 36328794d34SBenjamin Herrenschmidt#ifdef CONFIG_PPC_OF_BOOT_TRAMPOLINE 36414cf11afSPaul Mackerras /* Save parameters */ 36514cf11afSPaul Mackerras mr r31,r3 36614cf11afSPaul Mackerras mr r30,r4 36714cf11afSPaul Mackerras mr r29,r5 36814cf11afSPaul Mackerras mr r28,r6 36914cf11afSPaul Mackerras mr r27,r7 37014cf11afSPaul Mackerras 3716088857bSOlaf Hering /* 3726088857bSOlaf Hering * Align the stack to 16-byte boundary 3736088857bSOlaf Hering * Depending on the size and layout of the ELF sections in the initial 374e31aa453SPaul Mackerras * boot binary, the stack pointer may be unaligned on PowerMac 3756088857bSOlaf Hering */ 376c05b4770SLinus Torvalds rldicr r1,r1,0,59 377c05b4770SLinus Torvalds 378549e8152SPaul Mackerras#ifdef CONFIG_RELOCATABLE 379549e8152SPaul Mackerras /* Relocate code for where we are now */ 380549e8152SPaul Mackerras mr r3,r26 381549e8152SPaul Mackerras bl .relocate 382549e8152SPaul Mackerras#endif 383549e8152SPaul Mackerras 38414cf11afSPaul Mackerras /* Restore parameters */ 38514cf11afSPaul Mackerras mr r3,r31 38614cf11afSPaul Mackerras mr r4,r30 38714cf11afSPaul Mackerras mr r5,r29 38814cf11afSPaul Mackerras mr r6,r28 38914cf11afSPaul Mackerras mr r7,r27 39014cf11afSPaul Mackerras 39114cf11afSPaul Mackerras /* Do all of the interaction with OF client interface */ 392549e8152SPaul Mackerras mr r8,r26 39314cf11afSPaul Mackerras bl .prom_init 39428794d34SBenjamin Herrenschmidt#endif /* #CONFIG_PPC_OF_BOOT_TRAMPOLINE */ 39528794d34SBenjamin Herrenschmidt 39628794d34SBenjamin Herrenschmidt /* We never return. We also hit that trap if trying to boot 39728794d34SBenjamin Herrenschmidt * from OF while CONFIG_PPC_OF_BOOT_TRAMPOLINE isn't selected */ 39814cf11afSPaul Mackerras trap 39914cf11afSPaul Mackerras 40014cf11afSPaul Mackerras_STATIC(__after_prom_start) 401549e8152SPaul Mackerras#ifdef CONFIG_RELOCATABLE 402549e8152SPaul Mackerras /* process relocations for the final address of the kernel */ 403549e8152SPaul Mackerras lis r25,PAGE_OFFSET@highest /* compute virtual base of kernel */ 404549e8152SPaul Mackerras sldi r25,r25,32 4058b8b0cc1SMilton Miller lwz r7,__run_at_load-_stext(r26) 406928a3197SSonny Rao cmplwi cr0,r7,1 /* flagged to stay where we are ? */ 40754622f10SMohan Kumar M bne 1f 40854622f10SMohan Kumar M add r25,r25,r26 40954622f10SMohan Kumar M1: mr r3,r25 410549e8152SPaul Mackerras bl .relocate 411549e8152SPaul Mackerras#endif 41214cf11afSPaul Mackerras 41314cf11afSPaul Mackerras/* 414e31aa453SPaul Mackerras * We need to run with _stext at physical address PHYSICAL_START. 41514cf11afSPaul Mackerras * This will leave some code in the first 256B of 41614cf11afSPaul Mackerras * real memory, which are reserved for software use. 41714cf11afSPaul Mackerras * 41814cf11afSPaul Mackerras * Note: This process overwrites the OF exception vectors. 41914cf11afSPaul Mackerras */ 420549e8152SPaul Mackerras li r3,0 /* target addr */ 4212d27cfd3SBenjamin Herrenschmidt#ifdef CONFIG_PPC_BOOK3E 4222d27cfd3SBenjamin Herrenschmidt tovirt(r3,r3) /* on booke, we already run at PAGE_OFFSET */ 4232d27cfd3SBenjamin Herrenschmidt#endif 424549e8152SPaul Mackerras mr. r4,r26 /* In some cases the loader may */ 425e31aa453SPaul Mackerras beq 9f /* have already put us at zero */ 42614cf11afSPaul Mackerras li r6,0x100 /* Start offset, the first 0x100 */ 42714cf11afSPaul Mackerras /* bytes were copied earlier. */ 4282d27cfd3SBenjamin Herrenschmidt#ifdef CONFIG_PPC_BOOK3E 4292d27cfd3SBenjamin Herrenschmidt tovirt(r6,r6) /* on booke, we already run at PAGE_OFFSET */ 4302d27cfd3SBenjamin Herrenschmidt#endif 43114cf11afSPaul Mackerras 43254622f10SMohan Kumar M#ifdef CONFIG_CRASH_DUMP 43354622f10SMohan Kumar M/* 43454622f10SMohan Kumar M * Check if the kernel has to be running as relocatable kernel based on the 4358b8b0cc1SMilton Miller * variable __run_at_load, if it is set the kernel is treated as relocatable 43654622f10SMohan Kumar M * kernel, otherwise it will be moved to PHYSICAL_START 43754622f10SMohan Kumar M */ 4388b8b0cc1SMilton Miller lwz r7,__run_at_load-_stext(r26) 4398b8b0cc1SMilton Miller cmplwi cr0,r7,1 44054622f10SMohan Kumar M bne 3f 44154622f10SMohan Kumar M 44254622f10SMohan Kumar M li r5,__end_interrupts - _stext /* just copy interrupts */ 44354622f10SMohan Kumar M b 5f 44454622f10SMohan Kumar M3: 44554622f10SMohan Kumar M#endif 44654622f10SMohan Kumar M lis r5,(copy_to_here - _stext)@ha 44754622f10SMohan Kumar M addi r5,r5,(copy_to_here - _stext)@l /* # bytes of memory to copy */ 44854622f10SMohan Kumar M 44914cf11afSPaul Mackerras bl .copy_and_flush /* copy the first n bytes */ 45014cf11afSPaul Mackerras /* this includes the code being */ 45114cf11afSPaul Mackerras /* executed here. */ 452e31aa453SPaul Mackerras addis r8,r3,(4f - _stext)@ha /* Jump to the copy of this code */ 453e31aa453SPaul Mackerras addi r8,r8,(4f - _stext)@l /* that we just made */ 454e31aa453SPaul Mackerras mtctr r8 45514cf11afSPaul Mackerras bctr 45614cf11afSPaul Mackerras 45754622f10SMohan Kumar Mp_end: .llong _end - _stext 45854622f10SMohan Kumar M 459e31aa453SPaul Mackerras4: /* Now copy the rest of the kernel up to _end */ 460e31aa453SPaul Mackerras addis r5,r26,(p_end - _stext)@ha 461e31aa453SPaul Mackerras ld r5,(p_end - _stext)@l(r5) /* get _end */ 46254622f10SMohan Kumar M5: bl .copy_and_flush /* copy the rest */ 463e31aa453SPaul Mackerras 464e31aa453SPaul Mackerras9: b .start_here_multiplatform 465e31aa453SPaul Mackerras 46614cf11afSPaul Mackerras/* 46714cf11afSPaul Mackerras * Copy routine used to copy the kernel to start at physical address 0 46814cf11afSPaul Mackerras * and flush and invalidate the caches as needed. 46914cf11afSPaul Mackerras * r3 = dest addr, r4 = source addr, r5 = copy limit, r6 = start offset 47014cf11afSPaul Mackerras * on exit, r3, r4, r5 are unchanged, r6 is updated to be >= r5. 47114cf11afSPaul Mackerras * 47214cf11afSPaul Mackerras * Note: this routine *only* clobbers r0, r6 and lr 47314cf11afSPaul Mackerras */ 47414cf11afSPaul Mackerras_GLOBAL(copy_and_flush) 47514cf11afSPaul Mackerras addi r5,r5,-8 47614cf11afSPaul Mackerras addi r6,r6,-8 4775a2fe38dSOlof Johansson4: li r0,8 /* Use the smallest common */ 47814cf11afSPaul Mackerras /* denominator cache line */ 47914cf11afSPaul Mackerras /* size. This results in */ 48014cf11afSPaul Mackerras /* extra cache line flushes */ 48114cf11afSPaul Mackerras /* but operation is correct. */ 48214cf11afSPaul Mackerras /* Can't get cache line size */ 48314cf11afSPaul Mackerras /* from NACA as it is being */ 48414cf11afSPaul Mackerras /* moved too. */ 48514cf11afSPaul Mackerras 48614cf11afSPaul Mackerras mtctr r0 /* put # words/line in ctr */ 48714cf11afSPaul Mackerras3: addi r6,r6,8 /* copy a cache line */ 48814cf11afSPaul Mackerras ldx r0,r6,r4 48914cf11afSPaul Mackerras stdx r0,r6,r3 49014cf11afSPaul Mackerras bdnz 3b 49114cf11afSPaul Mackerras dcbst r6,r3 /* write it to memory */ 49214cf11afSPaul Mackerras sync 49314cf11afSPaul Mackerras icbi r6,r3 /* flush the icache line */ 49414cf11afSPaul Mackerras cmpld 0,r6,r5 49514cf11afSPaul Mackerras blt 4b 49614cf11afSPaul Mackerras sync 49714cf11afSPaul Mackerras addi r5,r5,8 49814cf11afSPaul Mackerras addi r6,r6,8 49914cf11afSPaul Mackerras blr 50014cf11afSPaul Mackerras 50114cf11afSPaul Mackerras.align 8 50214cf11afSPaul Mackerrascopy_to_here: 50314cf11afSPaul Mackerras 50414cf11afSPaul Mackerras#ifdef CONFIG_SMP 50514cf11afSPaul Mackerras#ifdef CONFIG_PPC_PMAC 50614cf11afSPaul Mackerras/* 50714cf11afSPaul Mackerras * On PowerMac, secondary processors starts from the reset vector, which 50814cf11afSPaul Mackerras * is temporarily turned into a call to one of the functions below. 50914cf11afSPaul Mackerras */ 51014cf11afSPaul Mackerras .section ".text"; 51114cf11afSPaul Mackerras .align 2 ; 51214cf11afSPaul Mackerras 51335499c01SPaul Mackerras .globl __secondary_start_pmac_0 51435499c01SPaul Mackerras__secondary_start_pmac_0: 51535499c01SPaul Mackerras /* NB the entries for cpus 0, 1, 2 must each occupy 8 bytes. */ 51635499c01SPaul Mackerras li r24,0 51735499c01SPaul Mackerras b 1f 51814cf11afSPaul Mackerras li r24,1 51935499c01SPaul Mackerras b 1f 52014cf11afSPaul Mackerras li r24,2 52135499c01SPaul Mackerras b 1f 52214cf11afSPaul Mackerras li r24,3 52335499c01SPaul Mackerras1: 52414cf11afSPaul Mackerras 52514cf11afSPaul Mackerras_GLOBAL(pmac_secondary_start) 52614cf11afSPaul Mackerras /* turn on 64-bit mode */ 52714cf11afSPaul Mackerras bl .enable_64b_mode 52814cf11afSPaul Mackerras 529c478b581SBenjamin Herrenschmidt li r0,0 530c478b581SBenjamin Herrenschmidt mfspr r3,SPRN_HID4 531c478b581SBenjamin Herrenschmidt rldimi r3,r0,40,23 /* clear bit 23 (rm_ci) */ 532c478b581SBenjamin Herrenschmidt sync 533c478b581SBenjamin Herrenschmidt mtspr SPRN_HID4,r3 534c478b581SBenjamin Herrenschmidt isync 535c478b581SBenjamin Herrenschmidt sync 536c478b581SBenjamin Herrenschmidt slbia 537c478b581SBenjamin Herrenschmidt 538e31aa453SPaul Mackerras /* get TOC pointer (real address) */ 539e31aa453SPaul Mackerras bl .relative_toc 540e31aa453SPaul Mackerras 54114cf11afSPaul Mackerras /* Copy some CPU settings from CPU 0 */ 542f39b7a55SOlof Johansson bl .__restore_cpu_ppc970 54314cf11afSPaul Mackerras 54414cf11afSPaul Mackerras /* pSeries do that early though I don't think we really need it */ 54514cf11afSPaul Mackerras mfmsr r3 54614cf11afSPaul Mackerras ori r3,r3,MSR_RI 54714cf11afSPaul Mackerras mtmsrd r3 /* RI on */ 54814cf11afSPaul Mackerras 54914cf11afSPaul Mackerras /* Set up a paca value for this processor. */ 5501426d5a3SMichael Ellerman LOAD_REG_ADDR(r4,paca) /* Load paca pointer */ 5511426d5a3SMichael Ellerman ld r4,0(r4) /* Get base vaddr of paca array */ 55214cf11afSPaul Mackerras mulli r13,r24,PACA_SIZE /* Calculate vaddr of right paca */ 55314cf11afSPaul Mackerras add r13,r13,r4 /* for this processor. */ 5542dd60d79SBenjamin Herrenschmidt SET_PACA(r13) /* Save vaddr of paca in an SPRG*/ 55514cf11afSPaul Mackerras 55662cc67b9SBenjamin Herrenschmidt /* Mark interrupts soft and hard disabled (they might be enabled 55762cc67b9SBenjamin Herrenschmidt * in the PACA when doing hotplug) 55862cc67b9SBenjamin Herrenschmidt */ 55962cc67b9SBenjamin Herrenschmidt li r0,0 56062cc67b9SBenjamin Herrenschmidt stb r0,PACASOFTIRQEN(r13) 56162cc67b9SBenjamin Herrenschmidt stb r0,PACAHARDIRQEN(r13) 56262cc67b9SBenjamin Herrenschmidt 56314cf11afSPaul Mackerras /* Create a temp kernel stack for use before relocation is on. */ 56414cf11afSPaul Mackerras ld r1,PACAEMERGSP(r13) 56514cf11afSPaul Mackerras subi r1,r1,STACK_FRAME_OVERHEAD 56614cf11afSPaul Mackerras 567c705677eSStephen Rothwell b __secondary_start 56814cf11afSPaul Mackerras 56914cf11afSPaul Mackerras#endif /* CONFIG_PPC_PMAC */ 57014cf11afSPaul Mackerras 57114cf11afSPaul Mackerras/* 57214cf11afSPaul Mackerras * This function is called after the master CPU has released the 57314cf11afSPaul Mackerras * secondary processors. The execution environment is relocation off. 57414cf11afSPaul Mackerras * The paca for this processor has the following fields initialized at 57514cf11afSPaul Mackerras * this point: 57614cf11afSPaul Mackerras * 1. Processor number 57714cf11afSPaul Mackerras * 2. Segment table pointer (virtual address) 57814cf11afSPaul Mackerras * On entry the following are set: 57914cf11afSPaul Mackerras * r1 = stack pointer. vaddr for iSeries, raddr (temp stack) for pSeries 58014cf11afSPaul Mackerras * r24 = cpu# (in Linux terms) 58114cf11afSPaul Mackerras * r13 = paca virtual address 582ee43eb78SBenjamin Herrenschmidt * SPRG_PACA = paca virtual address 58314cf11afSPaul Mackerras */ 5842d27cfd3SBenjamin Herrenschmidt .section ".text"; 5852d27cfd3SBenjamin Herrenschmidt .align 2 ; 5862d27cfd3SBenjamin Herrenschmidt 587fc68e869SStephen Rothwell .globl __secondary_start 588c705677eSStephen Rothwell__secondary_start: 589799d6046SPaul Mackerras /* Set thread priority to MEDIUM */ 590799d6046SPaul Mackerras HMT_MEDIUM 59114cf11afSPaul Mackerras 59214cf11afSPaul Mackerras /* Initialize the kernel stack. Just a repeat for iSeries. */ 593e58c3495SDavid Gibson LOAD_REG_ADDR(r3, current_set) 59414cf11afSPaul Mackerras sldi r28,r24,3 /* get current_set[cpu#] */ 59554a83404SMichael Neuling ldx r14,r3,r28 59654a83404SMichael Neuling addi r14,r14,THREAD_SIZE-STACK_FRAME_OVERHEAD 59754a83404SMichael Neuling std r14,PACAKSAVE(r13) 59814cf11afSPaul Mackerras 599f761622eSMatt Evans /* Do early setup for that CPU (stab, slb, hash table pointer) */ 600f761622eSMatt Evans bl .early_setup_secondary 601f761622eSMatt Evans 60254a83404SMichael Neuling /* 60354a83404SMichael Neuling * setup the new stack pointer, but *don't* use this until 60454a83404SMichael Neuling * translation is on. 60554a83404SMichael Neuling */ 60654a83404SMichael Neuling mr r1, r14 60754a83404SMichael Neuling 608799d6046SPaul Mackerras /* Clear backchain so we get nice backtraces */ 60914cf11afSPaul Mackerras li r7,0 61014cf11afSPaul Mackerras mtlr r7 61114cf11afSPaul Mackerras 61214cf11afSPaul Mackerras /* enable MMU and jump to start_secondary */ 613e58c3495SDavid Gibson LOAD_REG_ADDR(r3, .start_secondary_prolog) 614e58c3495SDavid Gibson LOAD_REG_IMMEDIATE(r4, MSR_KERNEL) 615d04c56f7SPaul Mackerras#ifdef CONFIG_PPC_ISERIES 6163f639ee8SStephen RothwellBEGIN_FW_FTR_SECTION 61714cf11afSPaul Mackerras ori r4,r4,MSR_EE 618ff3da2e0SBenjamin Herrenschmidt li r8,1 619ff3da2e0SBenjamin Herrenschmidt stb r8,PACAHARDIRQEN(r13) 6203f639ee8SStephen RothwellEND_FW_FTR_SECTION_IFSET(FW_FEATURE_ISERIES) 62114cf11afSPaul Mackerras#endif 622d04c56f7SPaul MackerrasBEGIN_FW_FTR_SECTION 623d04c56f7SPaul Mackerras stb r7,PACAHARDIRQEN(r13) 624d04c56f7SPaul MackerrasEND_FW_FTR_SECTION_IFCLR(FW_FEATURE_ISERIES) 625ff3da2e0SBenjamin Herrenschmidt stb r7,PACASOFTIRQEN(r13) 626d04c56f7SPaul Mackerras 627b5bbeb23SPaul Mackerras mtspr SPRN_SRR0,r3 628b5bbeb23SPaul Mackerras mtspr SPRN_SRR1,r4 6292d27cfd3SBenjamin Herrenschmidt RFI 63014cf11afSPaul Mackerras b . /* prevent speculative execution */ 63114cf11afSPaul Mackerras 63214cf11afSPaul Mackerras/* 63314cf11afSPaul Mackerras * Running with relocation on at this point. All we want to do is 634e31aa453SPaul Mackerras * zero the stack back-chain pointer and get the TOC virtual address 635e31aa453SPaul Mackerras * before going into C code. 63614cf11afSPaul Mackerras */ 63714cf11afSPaul Mackerras_GLOBAL(start_secondary_prolog) 638e31aa453SPaul Mackerras ld r2,PACATOC(r13) 63914cf11afSPaul Mackerras li r3,0 64014cf11afSPaul Mackerras std r3,0(r1) /* Zero the stack frame pointer */ 64114cf11afSPaul Mackerras bl .start_secondary 642799d6046SPaul Mackerras b . 6438dbce53cSVaidyanathan Srinivasan/* 6448dbce53cSVaidyanathan Srinivasan * Reset stack pointer and call start_secondary 6458dbce53cSVaidyanathan Srinivasan * to continue with online operation when woken up 6468dbce53cSVaidyanathan Srinivasan * from cede in cpu offline. 6478dbce53cSVaidyanathan Srinivasan */ 6488dbce53cSVaidyanathan Srinivasan_GLOBAL(start_secondary_resume) 6498dbce53cSVaidyanathan Srinivasan ld r1,PACAKSAVE(r13) /* Reload kernel stack pointer */ 6508dbce53cSVaidyanathan Srinivasan li r3,0 6518dbce53cSVaidyanathan Srinivasan std r3,0(r1) /* Zero the stack frame pointer */ 6528dbce53cSVaidyanathan Srinivasan bl .start_secondary 6538dbce53cSVaidyanathan Srinivasan b . 65414cf11afSPaul Mackerras#endif 65514cf11afSPaul Mackerras 65614cf11afSPaul Mackerras/* 65714cf11afSPaul Mackerras * This subroutine clobbers r11 and r12 65814cf11afSPaul Mackerras */ 65914cf11afSPaul Mackerras_GLOBAL(enable_64b_mode) 66014cf11afSPaul Mackerras mfmsr r11 /* grab the current MSR */ 6612d27cfd3SBenjamin Herrenschmidt#ifdef CONFIG_PPC_BOOK3E 6622d27cfd3SBenjamin Herrenschmidt oris r11,r11,0x8000 /* CM bit set, we'll set ICM later */ 6632d27cfd3SBenjamin Herrenschmidt mtmsr r11 6642d27cfd3SBenjamin Herrenschmidt#else /* CONFIG_PPC_BOOK3E */ 6659f0b0793SMichael Ellerman li r12,(MSR_64BIT | MSR_ISF)@highest 666e31aa453SPaul Mackerras sldi r12,r12,48 66714cf11afSPaul Mackerras or r11,r11,r12 66814cf11afSPaul Mackerras mtmsrd r11 66914cf11afSPaul Mackerras isync 6702d27cfd3SBenjamin Herrenschmidt#endif 67114cf11afSPaul Mackerras blr 67214cf11afSPaul Mackerras 67314cf11afSPaul Mackerras/* 674e31aa453SPaul Mackerras * This puts the TOC pointer into r2, offset by 0x8000 (as expected 675e31aa453SPaul Mackerras * by the toolchain). It computes the correct value for wherever we 676e31aa453SPaul Mackerras * are running at the moment, using position-independent code. 677e31aa453SPaul Mackerras */ 678e31aa453SPaul Mackerras_GLOBAL(relative_toc) 679e31aa453SPaul Mackerras mflr r0 680e31aa453SPaul Mackerras bcl 20,31,$+4 681e550592eSBenjamin Herrenschmidt0: mflr r11 682e550592eSBenjamin Herrenschmidt ld r2,(p_toc - 0b)(r11) 683e550592eSBenjamin Herrenschmidt add r2,r2,r11 684e31aa453SPaul Mackerras mtlr r0 685e31aa453SPaul Mackerras blr 686e31aa453SPaul Mackerras 687e31aa453SPaul Mackerrasp_toc: .llong __toc_start + 0x8000 - 0b 688e31aa453SPaul Mackerras 689e31aa453SPaul Mackerras/* 69014cf11afSPaul Mackerras * This is where the main kernel code starts. 69114cf11afSPaul Mackerras */ 692939e60f6SStephen Rothwell_INIT_STATIC(start_here_multiplatform) 693e31aa453SPaul Mackerras /* set up the TOC (real address) */ 694e31aa453SPaul Mackerras bl .relative_toc 69514cf11afSPaul Mackerras 69614cf11afSPaul Mackerras /* Clear out the BSS. It may have been done in prom_init, 69714cf11afSPaul Mackerras * already but that's irrelevant since prom_init will soon 69814cf11afSPaul Mackerras * be detached from the kernel completely. Besides, we need 69914cf11afSPaul Mackerras * to clear it now for kexec-style entry. 70014cf11afSPaul Mackerras */ 701e31aa453SPaul Mackerras LOAD_REG_ADDR(r11,__bss_stop) 702e31aa453SPaul Mackerras LOAD_REG_ADDR(r8,__bss_start) 70314cf11afSPaul Mackerras sub r11,r11,r8 /* bss size */ 70414cf11afSPaul Mackerras addi r11,r11,7 /* round up to an even double word */ 705e31aa453SPaul Mackerras srdi. r11,r11,3 /* shift right by 3 */ 70614cf11afSPaul Mackerras beq 4f 70714cf11afSPaul Mackerras addi r8,r8,-8 70814cf11afSPaul Mackerras li r0,0 70914cf11afSPaul Mackerras mtctr r11 /* zero this many doublewords */ 71014cf11afSPaul Mackerras3: stdu r0,8(r8) 71114cf11afSPaul Mackerras bdnz 3b 71214cf11afSPaul Mackerras4: 71314cf11afSPaul Mackerras 7142d27cfd3SBenjamin Herrenschmidt#ifndef CONFIG_PPC_BOOK3E 71514cf11afSPaul Mackerras mfmsr r6 71614cf11afSPaul Mackerras ori r6,r6,MSR_RI 71714cf11afSPaul Mackerras mtmsrd r6 /* RI on */ 7182d27cfd3SBenjamin Herrenschmidt#endif 71914cf11afSPaul Mackerras 720549e8152SPaul Mackerras#ifdef CONFIG_RELOCATABLE 721549e8152SPaul Mackerras /* Save the physical address we're running at in kernstart_addr */ 722549e8152SPaul Mackerras LOAD_REG_ADDR(r4, kernstart_addr) 723549e8152SPaul Mackerras clrldi r0,r25,2 724549e8152SPaul Mackerras std r0,0(r4) 725549e8152SPaul Mackerras#endif 726549e8152SPaul Mackerras 727e31aa453SPaul Mackerras /* The following gets the stack set up with the regs */ 72814cf11afSPaul Mackerras /* pointing to the real addr of the kernel stack. This is */ 72914cf11afSPaul Mackerras /* all done to support the C function call below which sets */ 73014cf11afSPaul Mackerras /* up the htab. This is done because we have relocated the */ 73114cf11afSPaul Mackerras /* kernel but are still running in real mode. */ 73214cf11afSPaul Mackerras 733e31aa453SPaul Mackerras LOAD_REG_ADDR(r3,init_thread_union) 73414cf11afSPaul Mackerras 735e31aa453SPaul Mackerras /* set up a stack pointer */ 73614cf11afSPaul Mackerras addi r1,r3,THREAD_SIZE 73714cf11afSPaul Mackerras li r0,0 73814cf11afSPaul Mackerras stdu r0,-STACK_FRAME_OVERHEAD(r1) 73914cf11afSPaul Mackerras 74014cf11afSPaul Mackerras /* Do very early kernel initializations, including initial hash table, 74114cf11afSPaul Mackerras * stab and slb setup before we turn on relocation. */ 74214cf11afSPaul Mackerras 74314cf11afSPaul Mackerras /* Restore parameters passed from prom_init/kexec */ 74414cf11afSPaul Mackerras mr r3,r31 745ee43eb78SBenjamin Herrenschmidt bl .early_setup /* also sets r13 and SPRG_PACA */ 74614cf11afSPaul Mackerras 747e31aa453SPaul Mackerras LOAD_REG_ADDR(r3, .start_here_common) 748e31aa453SPaul Mackerras ld r4,PACAKMSR(r13) 749b5bbeb23SPaul Mackerras mtspr SPRN_SRR0,r3 750b5bbeb23SPaul Mackerras mtspr SPRN_SRR1,r4 7512d27cfd3SBenjamin Herrenschmidt RFI 75214cf11afSPaul Mackerras b . /* prevent speculative execution */ 75314cf11afSPaul Mackerras 75414cf11afSPaul Mackerras /* This is where all platforms converge execution */ 755fc68e869SStephen Rothwell_INIT_GLOBAL(start_here_common) 75614cf11afSPaul Mackerras /* relocation is on at this point */ 75714cf11afSPaul Mackerras std r1,PACAKSAVE(r13) 75814cf11afSPaul Mackerras 759e31aa453SPaul Mackerras /* Load the TOC (virtual address) */ 760e31aa453SPaul Mackerras ld r2,PACATOC(r13) 761e31aa453SPaul Mackerras 76214cf11afSPaul Mackerras bl .setup_system 76314cf11afSPaul Mackerras 76414cf11afSPaul Mackerras /* Load up the kernel context */ 76514cf11afSPaul Mackerras5: 76614cf11afSPaul Mackerras li r5,0 767d04c56f7SPaul Mackerras stb r5,PACASOFTIRQEN(r13) /* Soft Disabled */ 768d04c56f7SPaul Mackerras#ifdef CONFIG_PPC_ISERIES 769d04c56f7SPaul MackerrasBEGIN_FW_FTR_SECTION 77014cf11afSPaul Mackerras mfmsr r5 771ff3da2e0SBenjamin Herrenschmidt ori r5,r5,MSR_EE /* Hard Enabled on iSeries*/ 77214cf11afSPaul Mackerras mtmsrd r5 773ff3da2e0SBenjamin Herrenschmidt li r5,1 7743f639ee8SStephen RothwellEND_FW_FTR_SECTION_IFSET(FW_FEATURE_ISERIES) 77514cf11afSPaul Mackerras#endif 776ff3da2e0SBenjamin Herrenschmidt stb r5,PACAHARDIRQEN(r13) /* Hard Disabled on others */ 77714cf11afSPaul Mackerras 77814cf11afSPaul Mackerras bl .start_kernel 77914cf11afSPaul Mackerras 780f1870f77SAnton Blanchard /* Not reached */ 781f1870f77SAnton Blanchard BUG_OPCODE 78214cf11afSPaul Mackerras 78314cf11afSPaul Mackerras/* 78414cf11afSPaul Mackerras * We put a few things here that have to be page-aligned. 78514cf11afSPaul Mackerras * This stuff goes at the beginning of the bss, which is page-aligned. 78614cf11afSPaul Mackerras */ 78714cf11afSPaul Mackerras .section ".bss" 78814cf11afSPaul Mackerras 78914cf11afSPaul Mackerras .align PAGE_SHIFT 79014cf11afSPaul Mackerras 79114cf11afSPaul Mackerras .globl empty_zero_page 79214cf11afSPaul Mackerrasempty_zero_page: 79314cf11afSPaul Mackerras .space PAGE_SIZE 79414cf11afSPaul Mackerras 79514cf11afSPaul Mackerras .globl swapper_pg_dir 79614cf11afSPaul Mackerrasswapper_pg_dir: 797ee7a76daSStephen Rothwell .space PGD_TABLE_SIZE 798