xref: /openbmc/linux/arch/powerpc/kernel/head_64.S (revision 4e991e3c16a350d1eeffc100ce3fb25292596d03)
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