12874c5fdSThomas Gleixner/* SPDX-License-Identifier: GPL-2.0-or-later */ 214cf11afSPaul Mackerras/* 314cf11afSPaul Mackerras * PowerPC version 414cf11afSPaul Mackerras * Copyright (C) 1995-1996 Gary Thomas (gdt@linuxppc.org) 514cf11afSPaul Mackerras * 614cf11afSPaul Mackerras * Rewritten by Cort Dougan (cort@cs.nmt.edu) for PReP 714cf11afSPaul Mackerras * Copyright (C) 1996 Cort Dougan <cort@cs.nmt.edu> 814cf11afSPaul Mackerras * Adapted for Power Macintosh by Paul Mackerras. 914cf11afSPaul Mackerras * Low-level exception handlers and MMU support 1014cf11afSPaul Mackerras * rewritten by Paul Mackerras. 1114cf11afSPaul Mackerras * Copyright (C) 1996 Paul Mackerras. 1214cf11afSPaul Mackerras * 1314cf11afSPaul Mackerras * Adapted for 64bit PowerPC by Dave Engebretsen, Peter Bergner, and 1414cf11afSPaul Mackerras * Mike Corrigan {engebret|bergner|mikejc}@us.ibm.com 1514cf11afSPaul Mackerras * 160ebc4cdaSBenjamin Herrenschmidt * This file contains the entry point for the 64-bit kernel along 170ebc4cdaSBenjamin Herrenschmidt * with some early initialization code common to all 64-bit powerpc 180ebc4cdaSBenjamin Herrenschmidt * variants. 1914cf11afSPaul Mackerras */ 2014cf11afSPaul Mackerras 2129a011fcSSathvika Vasireddy#include <linux/linkage.h> 2214cf11afSPaul Mackerras#include <linux/threads.h> 23c141611fSPaul Gortmaker#include <linux/init.h> 24b5bbeb23SPaul Mackerras#include <asm/reg.h> 2514cf11afSPaul Mackerras#include <asm/page.h> 2614cf11afSPaul Mackerras#include <asm/mmu.h> 2714cf11afSPaul Mackerras#include <asm/ppc_asm.h> 2857f26649SNicholas Piggin#include <asm/head-64.h> 2914cf11afSPaul Mackerras#include <asm/asm-offsets.h> 3014cf11afSPaul Mackerras#include <asm/bug.h> 3114cf11afSPaul Mackerras#include <asm/cputable.h> 3214cf11afSPaul Mackerras#include <asm/setup.h> 3314cf11afSPaul Mackerras#include <asm/hvcall.h> 346cb7bfebSDavid Gibson#include <asm/thread_info.h> 353f639ee8SStephen Rothwell#include <asm/firmware.h> 3616a15a30SStephen Rothwell#include <asm/page_64.h> 37945feb17SBenjamin Herrenschmidt#include <asm/irqflags.h> 382191d657SAlexander Graf#include <asm/kvm_book3s_asm.h> 3946f52210SStephen Rothwell#include <asm/ptrace.h> 407230c564SBenjamin Herrenschmidt#include <asm/hw_irq.h> 416becef7eSchenhui zhao#include <asm/cputhreads.h> 427a25d912SScott Wood#include <asm/ppc-opcode.h> 439445aa1aSAl Viro#include <asm/export.h> 442c86cd18SChristophe Leroy#include <asm/feature-fixups.h> 45879add77SChristophe Leroy#ifdef CONFIG_PPC_BOOK3S 46879add77SChristophe Leroy#include <asm/exception-64s.h> 47879add77SChristophe Leroy#else 48879add77SChristophe Leroy#include <asm/exception-64e.h> 49879add77SChristophe Leroy#endif 5014cf11afSPaul Mackerras 5125985edcSLucas De Marchi/* The physical memory is laid out such that the secondary processor 520ebc4cdaSBenjamin Herrenschmidt * spin code sits at 0x0000...0x00ff. On server, the vectors follow 530ebc4cdaSBenjamin Herrenschmidt * using the layout described in exceptions-64s.S 5414cf11afSPaul Mackerras */ 5514cf11afSPaul Mackerras 5614cf11afSPaul Mackerras/* 5714cf11afSPaul Mackerras * Entering into this code we make the following assumptions: 580ebc4cdaSBenjamin Herrenschmidt * 590ebc4cdaSBenjamin Herrenschmidt * For pSeries or server processors: 6014cf11afSPaul Mackerras * 1. The MMU is off & open firmware is running in real mode. 61339a3293SNicholas Piggin * 2. The primary CPU enters at __start. 62339a3293SNicholas Piggin * 3. If the RTAS supports "query-cpu-stopped-state", then secondary 63339a3293SNicholas Piggin * CPUs will enter as directed by "start-cpu" RTAS call, which is 64339a3293SNicholas Piggin * generic_secondary_smp_init, with PIR in r3. 65339a3293SNicholas Piggin * 4. Else the secondary CPUs will enter at secondary_hold (0x60) as 66339a3293SNicholas Piggin * directed by the "start-cpu" RTS call, with PIR in r3. 6727f44888SBenjamin Herrenschmidt * -or- For OPAL entry: 68339a3293SNicholas Piggin * 1. The MMU is off, processor in HV mode. 69339a3293SNicholas Piggin * 2. The primary CPU enters at 0 with device-tree in r3, OPAL base 70339a3293SNicholas Piggin * in r8, and entry in r9 for debugging purposes. 71339a3293SNicholas Piggin * 3. Secondary CPUs enter as directed by OPAL_START_CPU call, which 72339a3293SNicholas Piggin * is at generic_secondary_smp_init, with PIR in r3. 7314cf11afSPaul Mackerras * 740ebc4cdaSBenjamin Herrenschmidt * For Book3E processors: 750ebc4cdaSBenjamin Herrenschmidt * 1. The MMU is on running in AS0 in a state defined in ePAPR 760ebc4cdaSBenjamin Herrenschmidt * 2. The kernel is entered at __start 7714cf11afSPaul Mackerras */ 7814cf11afSPaul Mackerras 79b270bebdSNicholas Piggin/* 80b270bebdSNicholas Piggin * boot_from_prom and prom_init run at the physical address. Everything 81b270bebdSNicholas Piggin * after prom and kexec entry run at the virtual address (PAGE_OFFSET). 82b270bebdSNicholas Piggin * Secondaries run at the virtual address from generic_secondary_common_init 83b270bebdSNicholas Piggin * onward. 84b270bebdSNicholas Piggin */ 85b270bebdSNicholas Piggin 8657f26649SNicholas PigginOPEN_FIXED_SECTION(first_256B, 0x0, 0x100) 8757f26649SNicholas PigginUSE_FIXED_SECTION(first_256B) 8857f26649SNicholas Piggin /* 8957f26649SNicholas Piggin * Offsets are relative from the start of fixed section, and 9057f26649SNicholas Piggin * first_256B starts at 0. Offsets are a bit easier to use here 9157f26649SNicholas Piggin * than the fixed section entry macros. 9257f26649SNicholas Piggin */ 9357f26649SNicholas Piggin . = 0x0 9414cf11afSPaul Mackerras_GLOBAL(__start) 9514cf11afSPaul Mackerras /* NOP this out unconditionally */ 9614cf11afSPaul MackerrasBEGIN_FTR_SECTION 975c0484e2SBenjamin Herrenschmidt FIXUP_ENDIAN 98b1576fecSAnton Blanchard b __start_initialization_multiplatform 9914cf11afSPaul MackerrasEND_FTR_SECTION(0, 1) 10014cf11afSPaul Mackerras 10114cf11afSPaul Mackerras /* Catch branch to 0 in real mode */ 10214cf11afSPaul Mackerras trap 10314cf11afSPaul Mackerras 1042751b628SAnton Blanchard /* Secondary processors spin on this value until it becomes non-zero. 1052751b628SAnton Blanchard * When non-zero, it contains the real address of the function the cpu 1062751b628SAnton Blanchard * should jump to. 1071f6a93e4SPaul Mackerras */ 1087d4151b5SOlof Johansson .balign 8 10914cf11afSPaul Mackerras .globl __secondary_hold_spinloop 11014cf11afSPaul Mackerras__secondary_hold_spinloop: 111eb039161STobin C. Harding .8byte 0x0 11214cf11afSPaul Mackerras 11314cf11afSPaul Mackerras /* Secondary processors write this value with their cpu # */ 11414cf11afSPaul Mackerras /* after they enter the spin loop immediately below. */ 11514cf11afSPaul Mackerras .globl __secondary_hold_acknowledge 11614cf11afSPaul Mackerras__secondary_hold_acknowledge: 117eb039161STobin C. Harding .8byte 0x0 11814cf11afSPaul Mackerras 119928a3197SSonny Rao#ifdef CONFIG_RELOCATABLE 1208b8b0cc1SMilton Miller /* This flag is set to 1 by a loader if the kernel should run 1218b8b0cc1SMilton Miller * at the loaded address instead of the linked address. This 12287c78b61SMichael Ellerman * is used by kexec-tools to keep the kdump kernel in the 1238b8b0cc1SMilton Miller * crash_kernel region. The loader is responsible for 1248b8b0cc1SMilton Miller * observing the alignment requirement. 1258b8b0cc1SMilton Miller */ 12670839d20SNicholas Piggin 12770839d20SNicholas Piggin#ifdef CONFIG_RELOCATABLE_TEST 12870839d20SNicholas Piggin#define RUN_AT_LOAD_DEFAULT 1 /* Test relocation, do not copy to 0 */ 12970839d20SNicholas Piggin#else 13070839d20SNicholas Piggin#define RUN_AT_LOAD_DEFAULT 0x72756e30 /* "run0" -- relocate to 0 by default */ 13170839d20SNicholas Piggin#endif 13270839d20SNicholas Piggin 1338b8b0cc1SMilton Miller /* Do not move this variable as kexec-tools knows about it. */ 1348b8b0cc1SMilton Miller . = 0x5c 1358b8b0cc1SMilton Miller .globl __run_at_load 1368b8b0cc1SMilton Miller__run_at_load: 137d72c4a36SDaniel AxtensDEFINE_FIXED_SYMBOL(__run_at_load, first_256B) 13870839d20SNicholas Piggin .long RUN_AT_LOAD_DEFAULT 1398b8b0cc1SMilton Miller#endif 1408b8b0cc1SMilton Miller 14114cf11afSPaul Mackerras . = 0x60 14214cf11afSPaul Mackerras/* 14375423b7bSGeoff Levand * The following code is used to hold secondary processors 14475423b7bSGeoff Levand * in a spin loop after they have entered the kernel, but 14514cf11afSPaul Mackerras * before the bulk of the kernel has been relocated. This code 14614cf11afSPaul Mackerras * is relocated to physical address 0x60 before prom_init is run. 14714cf11afSPaul Mackerras * All of it must fit below the first exception vector at 0x100. 1481f6a93e4SPaul Mackerras * Use .globl here not _GLOBAL because we want __secondary_hold 1491f6a93e4SPaul Mackerras * to be the actual text address, not a descriptor. 15014cf11afSPaul Mackerras */ 1511f6a93e4SPaul Mackerras .globl __secondary_hold 1521f6a93e4SPaul Mackerras__secondary_hold: 1535c0484e2SBenjamin Herrenschmidt FIXUP_ENDIAN 154e0d68273SChristophe Leroy#ifndef CONFIG_PPC_BOOK3E_64 15514cf11afSPaul Mackerras mfmsr r24 15614cf11afSPaul Mackerras ori r24,r24,MSR_RI 15714cf11afSPaul Mackerras mtmsrd r24 /* RI on */ 1582d27cfd3SBenjamin Herrenschmidt#endif 159f1870f77SAnton Blanchard /* Grab our physical cpu number */ 16014cf11afSPaul Mackerras mr r24,r3 16196f013feSJimi Xenidis /* stash r4 for book3e */ 16296f013feSJimi Xenidis mr r25,r4 16314cf11afSPaul Mackerras 16414cf11afSPaul Mackerras /* Tell the master cpu we're here */ 16514cf11afSPaul Mackerras /* Relocation is off & we are located at an address less */ 16614cf11afSPaul Mackerras /* than 0x100, so only need to grab low order offset. */ 167d72c4a36SDaniel Axtens std r24,(ABS_ADDR(__secondary_hold_acknowledge, first_256B))(0) 16814cf11afSPaul Mackerras sync 16914cf11afSPaul Mackerras 17014cf11afSPaul Mackerras /* All secondary cpus wait here until told to start. */ 171ffc8e90dSNicholas Piggin100: ld r12,(ABS_ADDR(__secondary_hold_spinloop, first_256B))(0) 172cc7efbf9SAnton Blanchard cmpdi 0,r12,0 1731f6a93e4SPaul Mackerras beq 100b 17414cf11afSPaul Mackerras 175da665885SThiago Jung Bauermann#if defined(CONFIG_SMP) || defined(CONFIG_KEXEC_CORE) 176e0d68273SChristophe Leroy#ifdef CONFIG_PPC_BOOK3E_64 177cc7efbf9SAnton Blanchard tovirt(r12,r12) 17896f013feSJimi Xenidis#endif 179cc7efbf9SAnton Blanchard mtctr r12 18014cf11afSPaul Mackerras mr r3,r24 18196f013feSJimi Xenidis /* 18296f013feSJimi Xenidis * it may be the case that other platforms have r4 right to 18396f013feSJimi Xenidis * begin with, this gives us some safety in case it is not 18496f013feSJimi Xenidis */ 185e0d68273SChristophe Leroy#ifdef CONFIG_PPC_BOOK3E_64 18696f013feSJimi Xenidis mr r4,r25 18796f013feSJimi Xenidis#else 1882d27cfd3SBenjamin Herrenschmidt li r4,0 18996f013feSJimi Xenidis#endif 190dd797738SBenjamin Herrenschmidt /* Make sure that patched code is visible */ 191dd797738SBenjamin Herrenschmidt isync 192758438a7SMichael Ellerman bctr 19314cf11afSPaul Mackerras#else 19463ce271bSChristophe Leroy0: trap 19563ce271bSChristophe Leroy EMIT_BUG_ENTRY 0b, __FILE__, __LINE__, 0 19614cf11afSPaul Mackerras#endif 19757f26649SNicholas PigginCLOSE_FIXED_SECTION(first_256B) 19814cf11afSPaul Mackerras 19914cf11afSPaul Mackerras/* 2000ebc4cdaSBenjamin Herrenschmidt * On server, we include the exception vectors code here as it 2010ebc4cdaSBenjamin Herrenschmidt * relies on absolute addressing which is only possible within 2020ebc4cdaSBenjamin Herrenschmidt * this compilation unit 20314cf11afSPaul Mackerras */ 2040ebc4cdaSBenjamin Herrenschmidt#ifdef CONFIG_PPC_BOOK3S 2050ebc4cdaSBenjamin Herrenschmidt#include "exceptions-64s.S" 20657f26649SNicholas Piggin#else 20757f26649SNicholas PigginOPEN_TEXT_SECTION(0x100) 2081f6a93e4SPaul Mackerras#endif 20914cf11afSPaul Mackerras 21057f26649SNicholas PigginUSE_TEXT_SECTION() 21157f26649SNicholas Piggin 212e754f4d1SNicholas Piggin#include "interrupt_64.S" 213e754f4d1SNicholas Piggin 214e0d68273SChristophe Leroy#ifdef CONFIG_PPC_BOOK3E_64 215d17799f9Schenhui zhao/* 2166becef7eSchenhui zhao * The booting_thread_hwid holds the thread id we want to boot in cpu 2176becef7eSchenhui zhao * hotplug case. It is set by cpu hotplug code, and is invalid by default. 2186becef7eSchenhui zhao * The thread id is the same as the initial value of SPRN_PIR[THREAD_ID] 2196becef7eSchenhui zhao * bit field. 2206becef7eSchenhui zhao */ 2216becef7eSchenhui zhao .globl booting_thread_hwid 2226becef7eSchenhui zhaobooting_thread_hwid: 2236becef7eSchenhui zhao .long INVALID_THREAD_HWID 2246becef7eSchenhui zhao .align 3 2256becef7eSchenhui zhao/* 2266becef7eSchenhui zhao * start a thread in the same core 2276becef7eSchenhui zhao * input parameters: 2286becef7eSchenhui zhao * r3 = the thread physical id 2296becef7eSchenhui zhao * r4 = the entry point where thread starts 2306becef7eSchenhui zhao */ 2316becef7eSchenhui zhao_GLOBAL(book3e_start_thread) 2326becef7eSchenhui zhao LOAD_REG_IMMEDIATE(r5, MSR_KERNEL) 233f87f253bSNicholas Piggin cmpwi r3, 0 2346becef7eSchenhui zhao beq 10f 235f87f253bSNicholas Piggin cmpwi r3, 1 2366becef7eSchenhui zhao beq 11f 2376becef7eSchenhui zhao /* If the thread id is invalid, just exit. */ 2386becef7eSchenhui zhao b 13f 2396becef7eSchenhui zhao10: 2407a25d912SScott Wood MTTMR(TMRN_IMSR0, 5) 2417a25d912SScott Wood MTTMR(TMRN_INIA0, 4) 2426becef7eSchenhui zhao b 12f 2436becef7eSchenhui zhao11: 2447a25d912SScott Wood MTTMR(TMRN_IMSR1, 5) 2457a25d912SScott Wood MTTMR(TMRN_INIA1, 4) 2466becef7eSchenhui zhao12: 2476becef7eSchenhui zhao isync 2486becef7eSchenhui zhao li r6, 1 2496becef7eSchenhui zhao sld r6, r6, r3 2506becef7eSchenhui zhao mtspr SPRN_TENS, r6 2516becef7eSchenhui zhao13: 2526becef7eSchenhui zhao blr 2536becef7eSchenhui zhao 2546becef7eSchenhui zhao/* 255d17799f9Schenhui zhao * stop a thread in the same core 256d17799f9Schenhui zhao * input parameter: 257d17799f9Schenhui zhao * r3 = the thread physical id 258d17799f9Schenhui zhao */ 259d17799f9Schenhui zhao_GLOBAL(book3e_stop_thread) 260f87f253bSNicholas Piggin cmpwi r3, 0 261d17799f9Schenhui zhao beq 10f 262f87f253bSNicholas Piggin cmpwi r3, 1 263d17799f9Schenhui zhao beq 10f 264d17799f9Schenhui zhao /* If the thread id is invalid, just exit. */ 265d17799f9Schenhui zhao b 13f 266d17799f9Schenhui zhao10: 267d17799f9Schenhui zhao li r4, 1 268d17799f9Schenhui zhao sld r4, r4, r3 269d17799f9Schenhui zhao mtspr SPRN_TENC, r4 270d17799f9Schenhui zhao13: 271d17799f9Schenhui zhao blr 272d17799f9Schenhui zhao 273e16c8765SAndy Fleming_GLOBAL(fsl_secondary_thread_init) 274f34b3e19SScott Wood mfspr r4,SPRN_BUCSR 275f34b3e19SScott Wood 276e16c8765SAndy Fleming /* Enable branch prediction */ 277e16c8765SAndy Fleming lis r3,BUCSR_INIT@h 278e16c8765SAndy Fleming ori r3,r3,BUCSR_INIT@l 279e16c8765SAndy Fleming mtspr SPRN_BUCSR,r3 280e16c8765SAndy Fleming isync 281e16c8765SAndy Fleming 282e16c8765SAndy Fleming /* 283e16c8765SAndy Fleming * Fix PIR to match the linear numbering in the device tree. 284e16c8765SAndy Fleming * 285e16c8765SAndy Fleming * On e6500, the reset value of PIR uses the low three bits for 286e16c8765SAndy Fleming * the thread within a core, and the upper bits for the core 287e16c8765SAndy Fleming * number. There are two threads per core, so shift everything 288e16c8765SAndy Fleming * but the low bit right by two bits so that the cpu numbering is 289e16c8765SAndy Fleming * continuous. 290f34b3e19SScott Wood * 291f34b3e19SScott Wood * If the old value of BUCSR is non-zero, this thread has run 292f34b3e19SScott Wood * before. Thus, we assume we are coming from kexec or a similar 293f34b3e19SScott Wood * scenario, and PIR is already set to the correct value. This 294f34b3e19SScott Wood * is a bit of a hack, but there are limited opportunities for 295f34b3e19SScott Wood * getting information into the thread and the alternatives 296f34b3e19SScott Wood * seemed like they'd be overkill. We can't tell just by looking 297f34b3e19SScott Wood * at the old PIR value which state it's in, since the same value 298f34b3e19SScott Wood * could be valid for one thread out of reset and for a different 299f34b3e19SScott Wood * thread in Linux. 300e16c8765SAndy Fleming */ 301f34b3e19SScott Wood 302e16c8765SAndy Fleming mfspr r3, SPRN_PIR 303f34b3e19SScott Wood cmpwi r4,0 304f34b3e19SScott Wood bne 1f 305e16c8765SAndy Fleming rlwimi r3, r3, 30, 2, 30 306e16c8765SAndy Fleming mtspr SPRN_PIR, r3 307f34b3e19SScott Wood1: 30814cf11afSPaul Mackerras mr r24,r3 30914cf11afSPaul Mackerras 31014cf11afSPaul Mackerras /* turn on 64-bit mode */ 311b1576fecSAnton Blanchard bl enable_64b_mode 31214cf11afSPaul Mackerras 3132d27cfd3SBenjamin Herrenschmidt /* Book3E initialization */ 3142d27cfd3SBenjamin Herrenschmidt mr r3,r24 315b1576fecSAnton Blanchard bl book3e_secondary_thread_init 316b270bebdSNicholas Piggin bl relative_toc 317b270bebdSNicholas Piggin 3182d27cfd3SBenjamin Herrenschmidt b generic_secondary_common_init 3192d27cfd3SBenjamin Herrenschmidt 320e0d68273SChristophe Leroy#endif /* CONFIG_PPC_BOOK3E_64 */ 321529d2bd5SMichael Ellerman 3222d27cfd3SBenjamin Herrenschmidt/* 3232d27cfd3SBenjamin Herrenschmidt * On pSeries and most other platforms, secondary processors spin 3242d27cfd3SBenjamin Herrenschmidt * in the following code. 3252d27cfd3SBenjamin Herrenschmidt * At entry, r3 = this processor's number (physical cpu id) 3262d27cfd3SBenjamin Herrenschmidt * 3272d27cfd3SBenjamin Herrenschmidt * On Book3E, r4 = 1 to indicate that the initial TLB entry for 3282d27cfd3SBenjamin Herrenschmidt * this core already exists (setup via some other mechanism such 3292d27cfd3SBenjamin Herrenschmidt * as SCOM before entry). 3302d27cfd3SBenjamin Herrenschmidt */ 3312d27cfd3SBenjamin Herrenschmidt_GLOBAL(generic_secondary_smp_init) 3325c0484e2SBenjamin Herrenschmidt FIXUP_ENDIAN 3332d27cfd3SBenjamin Herrenschmidt mr r24,r3 3342d27cfd3SBenjamin Herrenschmidt mr r25,r4 3352d27cfd3SBenjamin Herrenschmidt 3362d27cfd3SBenjamin Herrenschmidt /* turn on 64-bit mode */ 337b1576fecSAnton Blanchard bl enable_64b_mode 3382d27cfd3SBenjamin Herrenschmidt 339e0d68273SChristophe Leroy#ifdef CONFIG_PPC_BOOK3E_64 3402d27cfd3SBenjamin Herrenschmidt /* Book3E initialization */ 3412d27cfd3SBenjamin Herrenschmidt mr r3,r24 3422d27cfd3SBenjamin Herrenschmidt mr r4,r25 343b1576fecSAnton Blanchard bl book3e_secondary_core_init 344b270bebdSNicholas Piggin /* Now NIA and r2 are relocated to PAGE_OFFSET if not already */ 3456becef7eSchenhui zhao/* 3466becef7eSchenhui zhao * After common core init has finished, check if the current thread is the 3476becef7eSchenhui zhao * one we wanted to boot. If not, start the specified thread and stop the 3486becef7eSchenhui zhao * current thread. 3496becef7eSchenhui zhao */ 3506becef7eSchenhui zhao LOAD_REG_ADDR(r4, booting_thread_hwid) 3516becef7eSchenhui zhao lwz r3, 0(r4) 3526becef7eSchenhui zhao li r5, INVALID_THREAD_HWID 3536becef7eSchenhui zhao cmpw r3, r5 3546becef7eSchenhui zhao beq 20f 3556becef7eSchenhui zhao 3566becef7eSchenhui zhao /* 3576becef7eSchenhui zhao * The value of booting_thread_hwid has been stored in r3, 3586becef7eSchenhui zhao * so make it invalid. 3596becef7eSchenhui zhao */ 3606becef7eSchenhui zhao stw r5, 0(r4) 3616becef7eSchenhui zhao 3626becef7eSchenhui zhao /* 3636becef7eSchenhui zhao * Get the current thread id and check if it is the one we wanted. 3646becef7eSchenhui zhao * If not, start the one specified in booting_thread_hwid and stop 3656becef7eSchenhui zhao * the current thread. 3666becef7eSchenhui zhao */ 3676becef7eSchenhui zhao mfspr r8, SPRN_TIR 3686becef7eSchenhui zhao cmpw r3, r8 3696becef7eSchenhui zhao beq 20f 3706becef7eSchenhui zhao 3716becef7eSchenhui zhao /* start the specified thread */ 3726becef7eSchenhui zhao LOAD_REG_ADDR(r5, fsl_secondary_thread_init) 3736becef7eSchenhui zhao ld r4, 0(r5) 3746becef7eSchenhui zhao bl book3e_start_thread 3756becef7eSchenhui zhao 3766becef7eSchenhui zhao /* stop the current thread */ 3776becef7eSchenhui zhao mr r3, r8 3786becef7eSchenhui zhao bl book3e_stop_thread 3796becef7eSchenhui zhao10: 3806becef7eSchenhui zhao b 10b 3816becef7eSchenhui zhao20: 382b270bebdSNicholas Piggin#else 383b270bebdSNicholas Piggin /* Now the MMU is off, can branch to our PAGE_OFFSET address */ 384b270bebdSNicholas Piggin bcl 20,31,$+4 385b270bebdSNicholas Piggin1: mflr r11 386b270bebdSNicholas Piggin addi r11,r11,(2f - 1b) 387b270bebdSNicholas Piggin tovirt(r11, r11) 388b270bebdSNicholas Piggin mtctr r11 389b270bebdSNicholas Piggin bctr 390b270bebdSNicholas Piggin2: 391b270bebdSNicholas Piggin bl relative_toc 3922d27cfd3SBenjamin Herrenschmidt#endif 3932d27cfd3SBenjamin Herrenschmidt 3942d27cfd3SBenjamin Herrenschmidtgeneric_secondary_common_init: 39514cf11afSPaul Mackerras /* Set up a paca value for this processor. Since we have the 39614cf11afSPaul Mackerras * physical cpu id in r24, we need to search the pacas to find 39714cf11afSPaul Mackerras * which logical id maps to our physical one. 39814cf11afSPaul Mackerras */ 399768d18adSMilton Miller#ifndef CONFIG_SMP 400b1576fecSAnton Blanchard b kexec_wait /* wait for next kernel if !SMP */ 401768d18adSMilton Miller#else 402d2e60075SNicholas Piggin LOAD_REG_ADDR(r8, paca_ptrs) /* Load paca_ptrs pointe */ 403d2e60075SNicholas Piggin ld r8,0(r8) /* Get base vaddr of array */ 404546a073dSYury Norov#if (NR_CPUS == 1) || defined(CONFIG_FORCE_NR_CPUS) 405546a073dSYury Norov LOAD_REG_IMMEDIATE(r7, NR_CPUS) 406546a073dSYury Norov#else 407768d18adSMilton Miller LOAD_REG_ADDR(r7, nr_cpu_ids) /* Load nr_cpu_ids address */ 408768d18adSMilton Miller lwz r7,0(r7) /* also the max paca allocated */ 409546a073dSYury Norov#endif 41014cf11afSPaul Mackerras li r5,0 /* logical cpu id */ 411d2e60075SNicholas Piggin1: 412d2e60075SNicholas Piggin sldi r9,r5,3 /* get paca_ptrs[] index from cpu id */ 413d2e60075SNicholas Piggin ldx r13,r9,r8 /* r13 = paca_ptrs[cpu id] */ 414d2e60075SNicholas Piggin lhz r6,PACAHWCPUID(r13) /* Load HW procid from paca */ 41514cf11afSPaul Mackerras cmpw r6,r24 /* Compare to our id */ 41614cf11afSPaul Mackerras beq 2f 41714cf11afSPaul Mackerras addi r5,r5,1 418768d18adSMilton Miller cmpw r5,r7 /* Check if more pacas exist */ 41914cf11afSPaul Mackerras blt 1b 42014cf11afSPaul Mackerras 42114cf11afSPaul Mackerras mr r3,r24 /* not found, copy phys to r3 */ 422b1576fecSAnton Blanchard b kexec_wait /* next kernel might do better */ 42314cf11afSPaul Mackerras 4242dd60d79SBenjamin Herrenschmidt2: SET_PACA(r13) 425e0d68273SChristophe Leroy#ifdef CONFIG_PPC_BOOK3E_64 4262d27cfd3SBenjamin Herrenschmidt addi r12,r13,PACA_EXTLB /* and TLB exc frame in another */ 4272d27cfd3SBenjamin Herrenschmidt mtspr SPRN_SPRG_TLB_EXFRAME,r12 4282d27cfd3SBenjamin Herrenschmidt#endif 4292d27cfd3SBenjamin Herrenschmidt 43014cf11afSPaul Mackerras /* From now on, r24 is expected to be logical cpuid */ 43114cf11afSPaul Mackerras mr r24,r5 432b6f6b98aSSonny Rao 4333c0b976bSJordan Niethe /* Create a temp kernel stack for use before relocation is on. */ 4343c0b976bSJordan Niethe ld r1,PACAEMERGSP(r13) 43590f1b431SNicholas Piggin subi r1,r1,STACK_FRAME_MIN_SIZE 4363c0b976bSJordan Niethe 437f39b7a55SOlof Johansson /* See if we need to call a cpu state restore handler */ 438e31aa453SPaul Mackerras LOAD_REG_ADDR(r23, cur_cpu_spec) 439f39b7a55SOlof Johansson ld r23,0(r23) 4402751b628SAnton Blanchard ld r12,CPU_SPEC_RESTORE(r23) 4412751b628SAnton Blanchard cmpdi 0,r12,0 4429d07bc84SBenjamin Herrenschmidt beq 3f 4437d40aff8SChristophe Leroy#ifdef CONFIG_PPC64_ELF_ABI_V1 4442751b628SAnton Blanchard ld r12,0(r12) 4452751b628SAnton Blanchard#endif 446cc7efbf9SAnton Blanchard mtctr r12 447f39b7a55SOlof Johansson bctrl 448f39b7a55SOlof Johansson 4497ac87abbSMatt Evans3: LOAD_REG_ADDR(r3, spinning_secondaries) /* Decrement spinning_secondaries */ 4509d07bc84SBenjamin Herrenschmidt lwarx r4,0,r3 4519d07bc84SBenjamin Herrenschmidt subi r4,r4,1 4529d07bc84SBenjamin Herrenschmidt stwcx. r4,0,r3 4539d07bc84SBenjamin Herrenschmidt bne 3b 4549d07bc84SBenjamin Herrenschmidt isync 4559d07bc84SBenjamin Herrenschmidt 4569d07bc84SBenjamin Herrenschmidt4: HMT_LOW 457ad0693eeSBenjamin Herrenschmidt lbz r23,PACAPROCSTART(r13) /* Test if this processor should */ 458ad0693eeSBenjamin Herrenschmidt /* start. */ 459ad0693eeSBenjamin Herrenschmidt cmpwi 0,r23,0 4609d07bc84SBenjamin Herrenschmidt beq 4b /* Loop until told to go */ 461ad0693eeSBenjamin Herrenschmidt 462ad0693eeSBenjamin Herrenschmidt sync /* order paca.run and cur_cpu_spec */ 4639d07bc84SBenjamin Herrenschmidt isync /* In case code patching happened */ 464ad0693eeSBenjamin Herrenschmidt 465c705677eSStephen Rothwell b __secondary_start 466768d18adSMilton Miller#endif /* SMP */ 46714cf11afSPaul Mackerras 468e31aa453SPaul Mackerras/* 469e31aa453SPaul Mackerras * Turn the MMU off. 470e31aa453SPaul Mackerras * Assumes we're mapped EA == RA if the MMU is on. 471e31aa453SPaul Mackerras */ 4722d27cfd3SBenjamin Herrenschmidt#ifdef CONFIG_PPC_BOOK3S 47329a011fcSSathvika VasireddySYM_FUNC_START_LOCAL(__mmu_off) 47414cf11afSPaul Mackerras mfmsr r3 47514cf11afSPaul Mackerras andi. r0,r3,MSR_IR|MSR_DR 47614cf11afSPaul Mackerras beqlr 477e31aa453SPaul Mackerras mflr r4 47814cf11afSPaul Mackerras andc r3,r3,r0 47914cf11afSPaul Mackerras mtspr SPRN_SRR0,r4 48014cf11afSPaul Mackerras mtspr SPRN_SRR1,r3 48114cf11afSPaul Mackerras sync 48214cf11afSPaul Mackerras rfid 48314cf11afSPaul Mackerras b . /* prevent speculative execution */ 48429a011fcSSathvika VasireddySYM_FUNC_END(__mmu_off) 48514cf11afSPaul Mackerras 48638d73b67SSathvika VasireddySYM_FUNC_START_LOCAL(start_initialization_book3s) 48758f24eeaSNicholas Piggin mflr r25 48858f24eeaSNicholas Piggin 48958f24eeaSNicholas Piggin /* Setup some critical 970 SPRs before switching MMU off */ 49058f24eeaSNicholas Piggin mfspr r0,SPRN_PVR 49158f24eeaSNicholas Piggin srwi r0,r0,16 49258f24eeaSNicholas Piggin cmpwi r0,0x39 /* 970 */ 49358f24eeaSNicholas Piggin beq 1f 49458f24eeaSNicholas Piggin cmpwi r0,0x3c /* 970FX */ 49558f24eeaSNicholas Piggin beq 1f 49658f24eeaSNicholas Piggin cmpwi r0,0x44 /* 970MP */ 49758f24eeaSNicholas Piggin beq 1f 49858f24eeaSNicholas Piggin cmpwi r0,0x45 /* 970GX */ 49958f24eeaSNicholas Piggin bne 2f 50058f24eeaSNicholas Piggin1: bl __cpu_preinit_ppc970 50158f24eeaSNicholas Piggin2: 50258f24eeaSNicholas Piggin 50358f24eeaSNicholas Piggin /* Switch off MMU if not already off */ 50458f24eeaSNicholas Piggin bl __mmu_off 50558f24eeaSNicholas Piggin 506b270bebdSNicholas Piggin /* Now the MMU is off, can return to our PAGE_OFFSET address */ 507b270bebdSNicholas Piggin tovirt(r25,r25) 50858f24eeaSNicholas Piggin mtlr r25 50958f24eeaSNicholas Piggin blr 51038d73b67SSathvika VasireddySYM_FUNC_END(start_initialization_book3s) 51158f24eeaSNicholas Piggin#endif 51214cf11afSPaul Mackerras 51314cf11afSPaul Mackerras/* 51414cf11afSPaul Mackerras * Here is our main kernel entry point. We support currently 2 kind of entries 51514cf11afSPaul Mackerras * depending on the value of r5. 51614cf11afSPaul Mackerras * 51714cf11afSPaul Mackerras * r5 != NULL -> OF entry, we go to prom_init, "legacy" parameter content 51814cf11afSPaul Mackerras * in r3...r7 51914cf11afSPaul Mackerras * 52014cf11afSPaul Mackerras * r5 == NULL -> kexec style entry. r3 is a physical pointer to the 52114cf11afSPaul Mackerras * DT block, r4 is a physical pointer to the kernel itself 52214cf11afSPaul Mackerras * 52314cf11afSPaul Mackerras */ 5246a3bab90SAnton Blanchard__start_initialization_multiplatform: 525e31aa453SPaul Mackerras /* Make sure we are running in 64 bits mode */ 526b1576fecSAnton Blanchard bl enable_64b_mode 527e31aa453SPaul Mackerras 528e1100ceeSNicholas Piggin /* Zero r13 (paca) so early program check / mce don't use it */ 529e1100ceeSNicholas Piggin li r13,0 530e1100ceeSNicholas Piggin 53114cf11afSPaul Mackerras /* 53214cf11afSPaul Mackerras * Are we booted from a PROM Of-type client-interface ? 53314cf11afSPaul Mackerras */ 53414cf11afSPaul Mackerras cmpldi cr0,r5,0 535939e60f6SStephen Rothwell beq 1f 536b1576fecSAnton Blanchard b __boot_from_prom /* yes -> prom */ 537939e60f6SStephen Rothwell1: 53814cf11afSPaul Mackerras /* Save parameters */ 53914cf11afSPaul Mackerras mr r31,r3 54014cf11afSPaul Mackerras mr r30,r4 541daea1175SBenjamin Herrenschmidt#ifdef CONFIG_PPC_EARLY_DEBUG_OPAL 542daea1175SBenjamin Herrenschmidt /* Save OPAL entry */ 543daea1175SBenjamin Herrenschmidt mr r28,r8 544daea1175SBenjamin Herrenschmidt mr r29,r9 545daea1175SBenjamin Herrenschmidt#endif 54614cf11afSPaul Mackerras 5474f18b9e6SNicholas Piggin /* Get TOC pointer (current runtime address) */ 5484f18b9e6SNicholas Piggin bl relative_toc 5494f18b9e6SNicholas Piggin 550b270bebdSNicholas Piggin /* These functions return to the virtual (PAGE_OFFSET) address */ 551e0d68273SChristophe Leroy#ifdef CONFIG_PPC_BOOK3E_64 552b1576fecSAnton Blanchard bl start_initialization_book3e 5532d27cfd3SBenjamin Herrenschmidt#else 55458f24eeaSNicholas Piggin bl start_initialization_book3s 555e0d68273SChristophe Leroy#endif /* CONFIG_PPC_BOOK3E_64 */ 5564f18b9e6SNicholas Piggin 557b270bebdSNicholas Piggin /* Get TOC pointer, virtual */ 5584f18b9e6SNicholas Piggin bl relative_toc 5594f18b9e6SNicholas Piggin 5604f18b9e6SNicholas Piggin /* find out where we are now */ 561b270bebdSNicholas Piggin 562b270bebdSNicholas Piggin /* OPAL doesn't pass base address in r4, have to derive it. */ 5634f18b9e6SNicholas Piggin bcl 20,31,$+4 5644f18b9e6SNicholas Piggin0: mflr r26 /* r26 = runtime addr here */ 5654f18b9e6SNicholas Piggin addis r26,r26,(_stext - 0b)@ha 5664f18b9e6SNicholas Piggin addi r26,r26,(_stext - 0b)@l /* current runtime base addr */ 5674f18b9e6SNicholas Piggin 56858f24eeaSNicholas Piggin b __after_prom_start 56914cf11afSPaul Mackerras 5706eeb9b3bSMichael Ellerman__REF 5716a3bab90SAnton Blanchard__boot_from_prom: 57228794d34SBenjamin Herrenschmidt#ifdef CONFIG_PPC_OF_BOOT_TRAMPOLINE 573b270bebdSNicholas Piggin /* Get TOC pointer, non-virtual */ 5744f18b9e6SNicholas Piggin bl relative_toc 5754f18b9e6SNicholas Piggin 5764f18b9e6SNicholas Piggin /* find out where we are now */ 5774f18b9e6SNicholas Piggin bcl 20,31,$+4 5784f18b9e6SNicholas Piggin0: mflr r26 /* r26 = runtime addr here */ 5794f18b9e6SNicholas Piggin addis r26,r26,(_stext - 0b)@ha 5804f18b9e6SNicholas Piggin addi r26,r26,(_stext - 0b)@l /* current runtime base addr */ 5814f18b9e6SNicholas Piggin 58214cf11afSPaul Mackerras /* Save parameters */ 58314cf11afSPaul Mackerras mr r31,r3 58414cf11afSPaul Mackerras mr r30,r4 58514cf11afSPaul Mackerras mr r29,r5 58614cf11afSPaul Mackerras mr r28,r6 58714cf11afSPaul Mackerras mr r27,r7 58814cf11afSPaul Mackerras 5896088857bSOlaf Hering /* 5906088857bSOlaf Hering * Align the stack to 16-byte boundary 5916088857bSOlaf Hering * Depending on the size and layout of the ELF sections in the initial 592e31aa453SPaul Mackerras * boot binary, the stack pointer may be unaligned on PowerMac 5936088857bSOlaf Hering */ 594c05b4770SLinus Torvalds rldicr r1,r1,0,59 595c05b4770SLinus Torvalds 596549e8152SPaul Mackerras#ifdef CONFIG_RELOCATABLE 597549e8152SPaul Mackerras /* Relocate code for where we are now */ 598549e8152SPaul Mackerras mr r3,r26 599b1576fecSAnton Blanchard bl relocate 600549e8152SPaul Mackerras#endif 601549e8152SPaul Mackerras 60214cf11afSPaul Mackerras /* Restore parameters */ 60314cf11afSPaul Mackerras mr r3,r31 60414cf11afSPaul Mackerras mr r4,r30 60514cf11afSPaul Mackerras mr r5,r29 60614cf11afSPaul Mackerras mr r6,r28 60714cf11afSPaul Mackerras mr r7,r27 60814cf11afSPaul Mackerras 60914cf11afSPaul Mackerras /* Do all of the interaction with OF client interface */ 610549e8152SPaul Mackerras mr r8,r26 611*4e991e3cSNicholas Piggin bl CFUNC(prom_init) 61228794d34SBenjamin Herrenschmidt#endif /* #CONFIG_PPC_OF_BOOT_TRAMPOLINE */ 61328794d34SBenjamin Herrenschmidt 61428794d34SBenjamin Herrenschmidt /* We never return. We also hit that trap if trying to boot 61528794d34SBenjamin Herrenschmidt * from OF while CONFIG_PPC_OF_BOOT_TRAMPOLINE isn't selected */ 61614cf11afSPaul Mackerras trap 6176eeb9b3bSMichael Ellerman .previous 61814cf11afSPaul Mackerras 6196a3bab90SAnton Blanchard__after_prom_start: 620549e8152SPaul Mackerras#ifdef CONFIG_RELOCATABLE 621549e8152SPaul Mackerras /* process relocations for the final address of the kernel */ 62257f26649SNicholas Piggin lwz r7,(FIXED_SYMBOL_ABS_ADDR(__run_at_load))(r26) 623928a3197SSonny Rao cmplwi cr0,r7,1 /* flagged to stay where we are ? */ 624b270bebdSNicholas Piggin mr r25,r26 /* then use current kernel base */ 625b270bebdSNicholas Piggin beq 1f 626b270bebdSNicholas Piggin LOAD_REG_IMMEDIATE(r25, PAGE_OFFSET) /* else use static kernel base */ 62754622f10SMohan Kumar M1: mr r3,r25 628b1576fecSAnton Blanchard bl relocate 629e0d68273SChristophe Leroy#if defined(CONFIG_PPC_BOOK3E_64) 6301cb6e064STiejun Chen /* IVPR needs to be set after relocation. */ 6311cb6e064STiejun Chen bl init_core_book3e 6321cb6e064STiejun Chen#endif 633549e8152SPaul Mackerras#endif 63414cf11afSPaul Mackerras 63514cf11afSPaul Mackerras/* 636e31aa453SPaul Mackerras * We need to run with _stext at physical address PHYSICAL_START. 63714cf11afSPaul Mackerras * This will leave some code in the first 256B of 63814cf11afSPaul Mackerras * real memory, which are reserved for software use. 63914cf11afSPaul Mackerras * 64014cf11afSPaul Mackerras * Note: This process overwrites the OF exception vectors. 64114cf11afSPaul Mackerras */ 642b270bebdSNicholas Piggin LOAD_REG_IMMEDIATE(r3, PAGE_OFFSET) 643549e8152SPaul Mackerras mr. r4,r26 /* In some cases the loader may */ 644e31aa453SPaul Mackerras beq 9f /* have already put us at zero */ 64514cf11afSPaul Mackerras li r6,0x100 /* Start offset, the first 0x100 */ 64614cf11afSPaul Mackerras /* bytes were copied earlier. */ 64714cf11afSPaul Mackerras 64811ee7e99SAnton Blanchard#ifdef CONFIG_RELOCATABLE 64954622f10SMohan Kumar M/* 65054622f10SMohan Kumar M * Check if the kernel has to be running as relocatable kernel based on the 6518b8b0cc1SMilton Miller * variable __run_at_load, if it is set the kernel is treated as relocatable 65254622f10SMohan Kumar M * kernel, otherwise it will be moved to PHYSICAL_START 65354622f10SMohan Kumar M */ 65457f26649SNicholas Piggin lwz r7,(FIXED_SYMBOL_ABS_ADDR(__run_at_load))(r26) 6558b8b0cc1SMilton Miller cmplwi cr0,r7,1 65654622f10SMohan Kumar M bne 3f 65754622f10SMohan Kumar M 658e0d68273SChristophe Leroy#ifdef CONFIG_PPC_BOOK3E_64 6591cb6e064STiejun Chen LOAD_REG_ADDR(r5, __end_interrupts) 6601cb6e064STiejun Chen LOAD_REG_ADDR(r11, _stext) 6611cb6e064STiejun Chen sub r5,r5,r11 6621cb6e064STiejun Chen#else 663c1fb6816SMichael Neuling /* just copy interrupts */ 664d7fb5b18SChristophe Leroy LOAD_REG_IMMEDIATE_SYM(r5, r11, FIXED_SYMBOL_ABS_ADDR(__end_interrupts)) 6651cb6e064STiejun Chen#endif 66654622f10SMohan Kumar M b 5f 66754622f10SMohan Kumar M3: 66854622f10SMohan Kumar M#endif 66957f26649SNicholas Piggin /* # bytes of memory to copy */ 670d72c4a36SDaniel Axtens lis r5,(ABS_ADDR(copy_to_here, text))@ha 671d72c4a36SDaniel Axtens addi r5,r5,(ABS_ADDR(copy_to_here, text))@l 67254622f10SMohan Kumar M 673b1576fecSAnton Blanchard bl copy_and_flush /* copy the first n bytes */ 67414cf11afSPaul Mackerras /* this includes the code being */ 67514cf11afSPaul Mackerras /* executed here. */ 67657f26649SNicholas Piggin /* Jump to the copy of this code that we just made */ 677d72c4a36SDaniel Axtens addis r8,r3,(ABS_ADDR(4f, text))@ha 678d72c4a36SDaniel Axtens addi r12,r8,(ABS_ADDR(4f, text))@l 679cc7efbf9SAnton Blanchard mtctr r12 68014cf11afSPaul Mackerras bctr 68114cf11afSPaul Mackerras 682286e4f90SAnton Blanchard.balign 8 683eb039161STobin C. Hardingp_end: .8byte _end - copy_to_here 68454622f10SMohan Kumar M 685573819e3SNicholas Piggin4: 686573819e3SNicholas Piggin /* 687573819e3SNicholas Piggin * Now copy the rest of the kernel up to _end, add 688573819e3SNicholas Piggin * _end - copy_to_here to the copy limit and run again. 689573819e3SNicholas Piggin */ 690d72c4a36SDaniel Axtens addis r8,r26,(ABS_ADDR(p_end, text))@ha 691d72c4a36SDaniel Axtens ld r8,(ABS_ADDR(p_end, text))@l(r8) 692573819e3SNicholas Piggin add r5,r5,r8 693b1576fecSAnton Blanchard5: bl copy_and_flush /* copy the rest */ 694e31aa453SPaul Mackerras 695b1576fecSAnton Blanchard9: b start_here_multiplatform 696e31aa453SPaul Mackerras 69714cf11afSPaul Mackerras/* 69814cf11afSPaul Mackerras * Copy routine used to copy the kernel to start at physical address 0 69914cf11afSPaul Mackerras * and flush and invalidate the caches as needed. 70014cf11afSPaul Mackerras * r3 = dest addr, r4 = source addr, r5 = copy limit, r6 = start offset 70114cf11afSPaul Mackerras * on exit, r3, r4, r5 are unchanged, r6 is updated to be >= r5. 70214cf11afSPaul Mackerras * 70314cf11afSPaul Mackerras * Note: this routine *only* clobbers r0, r6 and lr 70414cf11afSPaul Mackerras */ 70514cf11afSPaul Mackerras_GLOBAL(copy_and_flush) 70614cf11afSPaul Mackerras addi r5,r5,-8 70714cf11afSPaul Mackerras addi r6,r6,-8 7085a2fe38dSOlof Johansson4: li r0,8 /* Use the smallest common */ 70914cf11afSPaul Mackerras /* denominator cache line */ 71014cf11afSPaul Mackerras /* size. This results in */ 71114cf11afSPaul Mackerras /* extra cache line flushes */ 71214cf11afSPaul Mackerras /* but operation is correct. */ 71314cf11afSPaul Mackerras /* Can't get cache line size */ 71414cf11afSPaul Mackerras /* from NACA as it is being */ 71514cf11afSPaul Mackerras /* moved too. */ 71614cf11afSPaul Mackerras 71714cf11afSPaul Mackerras mtctr r0 /* put # words/line in ctr */ 71814cf11afSPaul Mackerras3: addi r6,r6,8 /* copy a cache line */ 71914cf11afSPaul Mackerras ldx r0,r6,r4 72014cf11afSPaul Mackerras stdx r0,r6,r3 72114cf11afSPaul Mackerras bdnz 3b 72214cf11afSPaul Mackerras dcbst r6,r3 /* write it to memory */ 72314cf11afSPaul Mackerras sync 72414cf11afSPaul Mackerras icbi r6,r3 /* flush the icache line */ 72514cf11afSPaul Mackerras cmpld 0,r6,r5 72614cf11afSPaul Mackerras blt 4b 72714cf11afSPaul Mackerras sync 72814cf11afSPaul Mackerras addi r5,r5,8 72914cf11afSPaul Mackerras addi r6,r6,8 73029ce3c50SMichael Neuling isync 73114cf11afSPaul Mackerras blr 73214cf11afSPaul Mackerras 7338119cefdSHari Bathini_ASM_NOKPROBE_SYMBOL(copy_and_flush); /* Called in real mode */ 7348119cefdSHari Bathini 73514cf11afSPaul Mackerras.align 8 73614cf11afSPaul Mackerrascopy_to_here: 73714cf11afSPaul Mackerras 73814cf11afSPaul Mackerras#ifdef CONFIG_SMP 73914cf11afSPaul Mackerras#ifdef CONFIG_PPC_PMAC 74014cf11afSPaul Mackerras/* 74114cf11afSPaul Mackerras * On PowerMac, secondary processors starts from the reset vector, which 74214cf11afSPaul Mackerras * is temporarily turned into a call to one of the functions below. 74314cf11afSPaul Mackerras */ 74414cf11afSPaul Mackerras .section ".text"; 74514cf11afSPaul Mackerras .align 2 ; 74614cf11afSPaul Mackerras 74735499c01SPaul Mackerras .globl __secondary_start_pmac_0 74835499c01SPaul Mackerras__secondary_start_pmac_0: 74935499c01SPaul Mackerras /* NB the entries for cpus 0, 1, 2 must each occupy 8 bytes. */ 75035499c01SPaul Mackerras li r24,0 75135499c01SPaul Mackerras b 1f 75214cf11afSPaul Mackerras li r24,1 75335499c01SPaul Mackerras b 1f 75414cf11afSPaul Mackerras li r24,2 75535499c01SPaul Mackerras b 1f 75614cf11afSPaul Mackerras li r24,3 75735499c01SPaul Mackerras1: 75814cf11afSPaul Mackerras 75914cf11afSPaul Mackerras_GLOBAL(pmac_secondary_start) 76014cf11afSPaul Mackerras /* turn on 64-bit mode */ 761b1576fecSAnton Blanchard bl enable_64b_mode 76214cf11afSPaul Mackerras 763c478b581SBenjamin Herrenschmidt li r0,0 764c478b581SBenjamin Herrenschmidt mfspr r3,SPRN_HID4 765c478b581SBenjamin Herrenschmidt rldimi r3,r0,40,23 /* clear bit 23 (rm_ci) */ 766c478b581SBenjamin Herrenschmidt sync 767c478b581SBenjamin Herrenschmidt mtspr SPRN_HID4,r3 768c478b581SBenjamin Herrenschmidt isync 769c478b581SBenjamin Herrenschmidt sync 770c478b581SBenjamin Herrenschmidt slbia 771c478b581SBenjamin Herrenschmidt 772b270bebdSNicholas Piggin /* Branch to our PAGE_OFFSET address */ 773b270bebdSNicholas Piggin bcl 20,31,$+4 774b270bebdSNicholas Piggin1: mflr r11 775b270bebdSNicholas Piggin addi r11,r11,(2f - 1b) 776b270bebdSNicholas Piggin tovirt(r11, r11) 777b270bebdSNicholas Piggin mtctr r11 778b270bebdSNicholas Piggin bctr 779b270bebdSNicholas Piggin2: 780b1576fecSAnton Blanchard bl relative_toc 781e31aa453SPaul Mackerras 78214cf11afSPaul Mackerras /* Copy some CPU settings from CPU 0 */ 783b1576fecSAnton Blanchard bl __restore_cpu_ppc970 78414cf11afSPaul Mackerras 78514cf11afSPaul Mackerras /* pSeries do that early though I don't think we really need it */ 78614cf11afSPaul Mackerras mfmsr r3 78714cf11afSPaul Mackerras ori r3,r3,MSR_RI 78814cf11afSPaul Mackerras mtmsrd r3 /* RI on */ 78914cf11afSPaul Mackerras 79014cf11afSPaul Mackerras /* Set up a paca value for this processor. */ 791d2e60075SNicholas Piggin LOAD_REG_ADDR(r4,paca_ptrs) /* Load paca pointer */ 792d2e60075SNicholas Piggin ld r4,0(r4) /* Get base vaddr of paca_ptrs array */ 793d2e60075SNicholas Piggin sldi r5,r24,3 /* get paca_ptrs[] index from cpu id */ 794d2e60075SNicholas Piggin ldx r13,r5,r4 /* r13 = paca_ptrs[cpu id] */ 7952dd60d79SBenjamin Herrenschmidt SET_PACA(r13) /* Save vaddr of paca in an SPRG*/ 79614cf11afSPaul Mackerras 79762cc67b9SBenjamin Herrenschmidt /* Mark interrupts soft and hard disabled (they might be enabled 79862cc67b9SBenjamin Herrenschmidt * in the PACA when doing hotplug) 79962cc67b9SBenjamin Herrenschmidt */ 800c2e480baSMadhavan Srinivasan li r0,IRQS_DISABLED 8014e26bc4aSMadhavan Srinivasan stb r0,PACAIRQSOFTMASK(r13) 8027230c564SBenjamin Herrenschmidt li r0,PACA_IRQ_HARD_DIS 8037230c564SBenjamin Herrenschmidt stb r0,PACAIRQHAPPENED(r13) 80462cc67b9SBenjamin Herrenschmidt 80514cf11afSPaul Mackerras /* Create a temp kernel stack for use before relocation is on. */ 80614cf11afSPaul Mackerras ld r1,PACAEMERGSP(r13) 80790f1b431SNicholas Piggin subi r1,r1,STACK_FRAME_MIN_SIZE 80814cf11afSPaul Mackerras 809c705677eSStephen Rothwell b __secondary_start 81014cf11afSPaul Mackerras 81114cf11afSPaul Mackerras#endif /* CONFIG_PPC_PMAC */ 81214cf11afSPaul Mackerras 81314cf11afSPaul Mackerras/* 81414cf11afSPaul Mackerras * This function is called after the master CPU has released the 81514cf11afSPaul Mackerras * secondary processors. The execution environment is relocation off. 81614cf11afSPaul Mackerras * The paca for this processor has the following fields initialized at 81714cf11afSPaul Mackerras * this point: 81814cf11afSPaul Mackerras * 1. Processor number 81914cf11afSPaul Mackerras * 2. Segment table pointer (virtual address) 82014cf11afSPaul Mackerras * On entry the following are set: 8214f8cf36fSBenjamin Herrenschmidt * r1 = stack pointer (real addr of temp stack) 82214cf11afSPaul Mackerras * r24 = cpu# (in Linux terms) 82314cf11afSPaul Mackerras * r13 = paca virtual address 824ee43eb78SBenjamin Herrenschmidt * SPRG_PACA = paca virtual address 82514cf11afSPaul Mackerras */ 8262d27cfd3SBenjamin Herrenschmidt .section ".text"; 8272d27cfd3SBenjamin Herrenschmidt .align 2 ; 8282d27cfd3SBenjamin Herrenschmidt 829fc68e869SStephen Rothwell .globl __secondary_start 830c705677eSStephen Rothwell__secondary_start: 831799d6046SPaul Mackerras /* Set thread priority to MEDIUM */ 832799d6046SPaul Mackerras HMT_MEDIUM 83314cf11afSPaul Mackerras 834eafd825eSMichael Ellerman /* 835eafd825eSMichael Ellerman * Do early setup for this CPU, in particular initialising the MMU so we 836eafd825eSMichael Ellerman * can turn it on below. This is a call to C, which is OK, we're still 837eafd825eSMichael Ellerman * running on the emergency stack. 838eafd825eSMichael Ellerman */ 839*4e991e3cSNicholas Piggin bl CFUNC(early_setup_secondary) 840f761622eSMatt Evans 84154a83404SMichael Neuling /* 842eafd825eSMichael Ellerman * The primary has initialized our kernel stack for us in the paca, grab 843eafd825eSMichael Ellerman * it and put it in r1. We must *not* use it until we turn on the MMU 844eafd825eSMichael Ellerman * below, because it may not be inside the RMO. 84554a83404SMichael Neuling */ 846eafd825eSMichael Ellerman ld r1, PACAKSAVE(r13) 84754a83404SMichael Neuling 848799d6046SPaul Mackerras /* Clear backchain so we get nice backtraces */ 84914cf11afSPaul Mackerras li r7,0 85014cf11afSPaul Mackerras mtlr r7 85114cf11afSPaul Mackerras 8527230c564SBenjamin Herrenschmidt /* Mark interrupts soft and hard disabled (they might be enabled 8537230c564SBenjamin Herrenschmidt * in the PACA when doing hotplug) 8547230c564SBenjamin Herrenschmidt */ 855c2e480baSMadhavan Srinivasan li r7,IRQS_DISABLED 8564e26bc4aSMadhavan Srinivasan stb r7,PACAIRQSOFTMASK(r13) 8577230c564SBenjamin Herrenschmidt li r0,PACA_IRQ_HARD_DIS 8587230c564SBenjamin Herrenschmidt stb r0,PACAIRQHAPPENED(r13) 8594f8cf36fSBenjamin Herrenschmidt 86014cf11afSPaul Mackerras /* enable MMU and jump to start_secondary */ 861ad0289e4SAnton Blanchard LOAD_REG_ADDR(r3, start_secondary_prolog) 862e58c3495SDavid Gibson LOAD_REG_IMMEDIATE(r4, MSR_KERNEL) 863d04c56f7SPaul Mackerras 864b5bbeb23SPaul Mackerras mtspr SPRN_SRR0,r3 865b5bbeb23SPaul Mackerras mtspr SPRN_SRR1,r4 866879add77SChristophe Leroy RFI_TO_KERNEL 86714cf11afSPaul Mackerras b . /* prevent speculative execution */ 86814cf11afSPaul Mackerras 86914cf11afSPaul Mackerras/* 87014cf11afSPaul Mackerras * Running with relocation on at this point. All we want to do is 871e31aa453SPaul Mackerras * zero the stack back-chain pointer and get the TOC virtual address 872e31aa453SPaul Mackerras * before going into C code. 87314cf11afSPaul Mackerras */ 874ad0289e4SAnton Blanchardstart_secondary_prolog: 8758e93fb33SNicholas Piggin LOAD_PACA_TOC() 87614cf11afSPaul Mackerras li r3,0 87714cf11afSPaul Mackerras std r3,0(r1) /* Zero the stack frame pointer */ 878*4e991e3cSNicholas Piggin bl CFUNC(start_secondary) 879799d6046SPaul Mackerras b . 8808dbce53cSVaidyanathan Srinivasan/* 8818dbce53cSVaidyanathan Srinivasan * Reset stack pointer and call start_secondary 8828dbce53cSVaidyanathan Srinivasan * to continue with online operation when woken up 8838dbce53cSVaidyanathan Srinivasan * from cede in cpu offline. 8848dbce53cSVaidyanathan Srinivasan */ 8858dbce53cSVaidyanathan Srinivasan_GLOBAL(start_secondary_resume) 8868dbce53cSVaidyanathan Srinivasan ld r1,PACAKSAVE(r13) /* Reload kernel stack pointer */ 8878dbce53cSVaidyanathan Srinivasan li r3,0 8888dbce53cSVaidyanathan Srinivasan std r3,0(r1) /* Zero the stack frame pointer */ 889*4e991e3cSNicholas Piggin bl CFUNC(start_secondary) 8908dbce53cSVaidyanathan Srinivasan b . 89114cf11afSPaul Mackerras#endif 89214cf11afSPaul Mackerras 89314cf11afSPaul Mackerras/* 89414cf11afSPaul Mackerras * This subroutine clobbers r11 and r12 89514cf11afSPaul Mackerras */ 89629a011fcSSathvika VasireddySYM_FUNC_START_LOCAL(enable_64b_mode) 89714cf11afSPaul Mackerras mfmsr r11 /* grab the current MSR */ 898e0d68273SChristophe Leroy#ifdef CONFIG_PPC_BOOK3E_64 8992d27cfd3SBenjamin Herrenschmidt oris r11,r11,0x8000 /* CM bit set, we'll set ICM later */ 9002d27cfd3SBenjamin Herrenschmidt mtmsr r11 901e0d68273SChristophe Leroy#else /* CONFIG_PPC_BOOK3E_64 */ 902e89a8ca9SNicholas Piggin LOAD_REG_IMMEDIATE(r12, MSR_64BIT) 90314cf11afSPaul Mackerras or r11,r11,r12 90414cf11afSPaul Mackerras mtmsrd r11 90514cf11afSPaul Mackerras isync 9062d27cfd3SBenjamin Herrenschmidt#endif 90714cf11afSPaul Mackerras blr 90829a011fcSSathvika VasireddySYM_FUNC_END(enable_64b_mode) 90914cf11afSPaul Mackerras 91014cf11afSPaul Mackerras/* 911e31aa453SPaul Mackerras * This puts the TOC pointer into r2, offset by 0x8000 (as expected 912e31aa453SPaul Mackerras * by the toolchain). It computes the correct value for wherever we 913e31aa453SPaul Mackerras * are running at the moment, using position-independent code. 9141fbe9cf2SAnton Blanchard * 9151fbe9cf2SAnton Blanchard * Note: The compiler constructs pointers using offsets from the 9161fbe9cf2SAnton Blanchard * TOC in -mcmodel=medium mode. After we relocate to 0 but before 9171fbe9cf2SAnton Blanchard * the MMU is on we need our TOC to be a virtual address otherwise 9181fbe9cf2SAnton Blanchard * these pointers will be real addresses which may get stored and 919b270bebdSNicholas Piggin * accessed later with the MMU on. We branch to the virtual address 920b270bebdSNicholas Piggin * while still in real mode then call relative_toc again to handle 921b270bebdSNicholas Piggin * this. 922e31aa453SPaul Mackerras */ 923e31aa453SPaul Mackerras_GLOBAL(relative_toc) 924e31aa453SPaul Mackerras mflr r0 925e31aa453SPaul Mackerras bcl 20,31,$+4 926e550592eSBenjamin Herrenschmidt0: mflr r11 927e550592eSBenjamin Herrenschmidt ld r2,(p_toc - 0b)(r11) 928e550592eSBenjamin Herrenschmidt add r2,r2,r11 929e31aa453SPaul Mackerras mtlr r0 930e31aa453SPaul Mackerras blr 931e31aa453SPaul Mackerras 9325b63fee1SAnton Blanchard.balign 8 933a3ad84daSAlan Modrap_toc: .8byte .TOC. - 0b 934e31aa453SPaul Mackerras 935e31aa453SPaul Mackerras/* 93614cf11afSPaul Mackerras * This is where the main kernel code starts. 93714cf11afSPaul Mackerras */ 9389c4e4c90SChristophe Leroy__REF 9396a3bab90SAnton Blanchardstart_here_multiplatform: 940b270bebdSNicholas Piggin /* Adjust TOC for moved kernel. Could adjust when moving it instead. */ 941b1576fecSAnton Blanchard bl relative_toc 94214cf11afSPaul Mackerras 94314cf11afSPaul Mackerras /* Clear out the BSS. It may have been done in prom_init, 94414cf11afSPaul Mackerras * already but that's irrelevant since prom_init will soon 94514cf11afSPaul Mackerras * be detached from the kernel completely. Besides, we need 94614cf11afSPaul Mackerras * to clear it now for kexec-style entry. 94714cf11afSPaul Mackerras */ 948e31aa453SPaul Mackerras LOAD_REG_ADDR(r11,__bss_stop) 949e31aa453SPaul Mackerras LOAD_REG_ADDR(r8,__bss_start) 95014cf11afSPaul Mackerras sub r11,r11,r8 /* bss size */ 95114cf11afSPaul Mackerras addi r11,r11,7 /* round up to an even double word */ 952e31aa453SPaul Mackerras srdi. r11,r11,3 /* shift right by 3 */ 95314cf11afSPaul Mackerras beq 4f 95414cf11afSPaul Mackerras addi r8,r8,-8 95514cf11afSPaul Mackerras li r0,0 95614cf11afSPaul Mackerras mtctr r11 /* zero this many doublewords */ 95714cf11afSPaul Mackerras3: stdu r0,8(r8) 95814cf11afSPaul Mackerras bdnz 3b 95914cf11afSPaul Mackerras4: 96014cf11afSPaul Mackerras 961daea1175SBenjamin Herrenschmidt#ifdef CONFIG_PPC_EARLY_DEBUG_OPAL 962daea1175SBenjamin Herrenschmidt /* Setup OPAL entry */ 963ab7f961aSBenjamin Herrenschmidt LOAD_REG_ADDR(r11, opal) 964daea1175SBenjamin Herrenschmidt std r28,0(r11); 965daea1175SBenjamin Herrenschmidt std r29,8(r11); 966daea1175SBenjamin Herrenschmidt#endif 967daea1175SBenjamin Herrenschmidt 968e0d68273SChristophe Leroy#ifndef CONFIG_PPC_BOOK3E_64 96914cf11afSPaul Mackerras mfmsr r6 97014cf11afSPaul Mackerras ori r6,r6,MSR_RI 97114cf11afSPaul Mackerras mtmsrd r6 /* RI on */ 9722d27cfd3SBenjamin Herrenschmidt#endif 97314cf11afSPaul Mackerras 974549e8152SPaul Mackerras#ifdef CONFIG_RELOCATABLE 975549e8152SPaul Mackerras /* Save the physical address we're running at in kernstart_addr */ 976549e8152SPaul Mackerras LOAD_REG_ADDR(r4, kernstart_addr) 977549e8152SPaul Mackerras clrldi r0,r25,2 978549e8152SPaul Mackerras std r0,0(r4) 979549e8152SPaul Mackerras#endif 980549e8152SPaul Mackerras 981e31aa453SPaul Mackerras /* set up a stack pointer */ 9827ffa8b7dSMichael Ellerman LOAD_REG_ADDR(r3,init_thread_union) 983cabed148SHamish Martin LOAD_REG_IMMEDIATE(r1,THREAD_SIZE) 984cabed148SHamish Martin add r1,r3,r1 98514cf11afSPaul Mackerras li r0,0 98690f1b431SNicholas Piggin stdu r0,-STACK_FRAME_MIN_SIZE(r1) 98714cf11afSPaul Mackerras 988376af594SMichael Ellerman /* 989376af594SMichael Ellerman * Do very early kernel initializations, including initial hash table 990376af594SMichael Ellerman * and SLB setup before we turn on relocation. 991376af594SMichael Ellerman */ 99214cf11afSPaul Mackerras 993c7b9ed7cSChristophe Leroy#ifdef CONFIG_KASAN 994*4e991e3cSNicholas Piggin bl CFUNC(kasan_early_init) 995c7b9ed7cSChristophe Leroy#endif 99614cf11afSPaul Mackerras /* Restore parameters passed from prom_init/kexec */ 99714cf11afSPaul Mackerras mr r3,r31 99856c46bbaSRussell Currey LOAD_REG_ADDR(r12, DOTSYM(early_setup)) 99956c46bbaSRussell Currey mtctr r12 100056c46bbaSRussell Currey bctrl /* also sets r13 and SPRG_PACA */ 100114cf11afSPaul Mackerras 1002ad0289e4SAnton Blanchard LOAD_REG_ADDR(r3, start_here_common) 1003e31aa453SPaul Mackerras ld r4,PACAKMSR(r13) 1004b5bbeb23SPaul Mackerras mtspr SPRN_SRR0,r3 1005b5bbeb23SPaul Mackerras mtspr SPRN_SRR1,r4 1006879add77SChristophe Leroy RFI_TO_KERNEL 100714cf11afSPaul Mackerras b . /* prevent speculative execution */ 100814cf11afSPaul Mackerras 100914cf11afSPaul Mackerras /* This is where all platforms converge execution */ 1010ad0289e4SAnton Blanchard 1011ad0289e4SAnton Blanchardstart_here_common: 101214cf11afSPaul Mackerras /* relocation is on at this point */ 101314cf11afSPaul Mackerras std r1,PACAKSAVE(r13) 101414cf11afSPaul Mackerras 1015e31aa453SPaul Mackerras /* Load the TOC (virtual address) */ 10168e93fb33SNicholas Piggin LOAD_PACA_TOC() 101714cf11afSPaul Mackerras 10187230c564SBenjamin Herrenschmidt /* Mark interrupts soft and hard disabled (they might be enabled 10197230c564SBenjamin Herrenschmidt * in the PACA when doing hotplug) 10207230c564SBenjamin Herrenschmidt */ 1021c2e480baSMadhavan Srinivasan li r0,IRQS_DISABLED 10224e26bc4aSMadhavan Srinivasan stb r0,PACAIRQSOFTMASK(r13) 10237230c564SBenjamin Herrenschmidt li r0,PACA_IRQ_HARD_DIS 10247230c564SBenjamin Herrenschmidt stb r0,PACAIRQHAPPENED(r13) 102514cf11afSPaul Mackerras 10267230c564SBenjamin Herrenschmidt /* Generic kernel entry */ 1027*4e991e3cSNicholas Piggin bl CFUNC(start_kernel) 102814cf11afSPaul Mackerras 1029f1870f77SAnton Blanchard /* Not reached */ 1030fe18a35eSJordan Niethe0: trap 103163ce271bSChristophe Leroy EMIT_BUG_ENTRY 0b, __FILE__, __LINE__, 0 10326eeb9b3bSMichael Ellerman .previous 1033