| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 1 | /* | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 2 | *  PowerPC version | 
|  | 3 | *    Copyright (C) 1995-1996 Gary Thomas (gdt@linuxppc.org) | 
|  | 4 | * | 
|  | 5 | *  Rewritten by Cort Dougan (cort@cs.nmt.edu) for PReP | 
|  | 6 | *    Copyright (C) 1996 Cort Dougan <cort@cs.nmt.edu> | 
|  | 7 | *  Adapted for Power Macintosh by Paul Mackerras. | 
|  | 8 | *  Low-level exception handlers and MMU support | 
|  | 9 | *  rewritten by Paul Mackerras. | 
|  | 10 | *    Copyright (C) 1996 Paul Mackerras. | 
|  | 11 | * | 
|  | 12 | *  Adapted for 64bit PowerPC by Dave Engebretsen, Peter Bergner, and | 
|  | 13 | *    Mike Corrigan {engebret|bergner|mikejc}@us.ibm.com | 
|  | 14 | * | 
| Benjamin Herrenschmidt | 0ebc4cd | 2009-06-02 21:17:38 +0000 | [diff] [blame] | 15 | *  This file contains the entry point for the 64-bit kernel along | 
|  | 16 | *  with some early initialization code common to all 64-bit powerpc | 
|  | 17 | *  variants. | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 18 | * | 
|  | 19 | *  This program is free software; you can redistribute it and/or | 
|  | 20 | *  modify it under the terms of the GNU General Public License | 
|  | 21 | *  as published by the Free Software Foundation; either version | 
|  | 22 | *  2 of the License, or (at your option) any later version. | 
|  | 23 | */ | 
|  | 24 |  | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 25 | #include <linux/threads.h> | 
| Paul Mackerras | b5bbeb2 | 2005-10-10 14:01:07 +1000 | [diff] [blame] | 26 | #include <asm/reg.h> | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 27 | #include <asm/page.h> | 
|  | 28 | #include <asm/mmu.h> | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 29 | #include <asm/ppc_asm.h> | 
|  | 30 | #include <asm/asm-offsets.h> | 
|  | 31 | #include <asm/bug.h> | 
|  | 32 | #include <asm/cputable.h> | 
|  | 33 | #include <asm/setup.h> | 
|  | 34 | #include <asm/hvcall.h> | 
| Kelly Daly | c43a55f | 2005-11-02 15:02:47 +1100 | [diff] [blame] | 35 | #include <asm/iseries/lpar_map.h> | 
| David Gibson | 6cb7bfe | 2005-10-21 15:45:50 +1000 | [diff] [blame] | 36 | #include <asm/thread_info.h> | 
| Stephen Rothwell | 3f639ee | 2006-09-25 18:19:00 +1000 | [diff] [blame] | 37 | #include <asm/firmware.h> | 
| Stephen Rothwell | 16a15a3 | 2007-08-20 14:58:36 +1000 | [diff] [blame] | 38 | #include <asm/page_64.h> | 
| Benjamin Herrenschmidt | 945feb1 | 2008-04-17 14:35:01 +1000 | [diff] [blame] | 39 | #include <asm/irqflags.h> | 
| Alexander Graf | 2191d65 | 2010-04-16 00:11:32 +0200 | [diff] [blame] | 40 | #include <asm/kvm_book3s_asm.h> | 
| Stephen Rothwell | 46f5221 | 2010-11-18 15:06:17 +0000 | [diff] [blame] | 41 | #include <asm/ptrace.h> | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 42 |  | 
| Lucas De Marchi | 25985ed | 2011-03-30 22:57:33 -0300 | [diff] [blame] | 43 | /* The physical memory is laid out such that the secondary processor | 
| Benjamin Herrenschmidt | 0ebc4cd | 2009-06-02 21:17:38 +0000 | [diff] [blame] | 44 | * spin code sits at 0x0000...0x00ff. On server, the vectors follow | 
|  | 45 | * using the layout described in exceptions-64s.S | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 46 | */ | 
|  | 47 |  | 
|  | 48 | /* | 
|  | 49 | * Entering into this code we make the following assumptions: | 
| Benjamin Herrenschmidt | 0ebc4cd | 2009-06-02 21:17:38 +0000 | [diff] [blame] | 50 | * | 
|  | 51 | *  For pSeries or server processors: | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 52 | *   1. The MMU is off & open firmware is running in real mode. | 
|  | 53 | *   2. The kernel is entered at __start | 
|  | 54 | * | 
|  | 55 | *  For iSeries: | 
|  | 56 | *   1. The MMU is on (as it always is for iSeries) | 
|  | 57 | *   2. The kernel is entered at system_reset_iSeries | 
| Benjamin Herrenschmidt | 0ebc4cd | 2009-06-02 21:17:38 +0000 | [diff] [blame] | 58 | * | 
|  | 59 | *  For Book3E processors: | 
|  | 60 | *   1. The MMU is on running in AS0 in a state defined in ePAPR | 
|  | 61 | *   2. The kernel is entered at __start | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 62 | */ | 
|  | 63 |  | 
|  | 64 | .text | 
|  | 65 | .globl  _stext | 
|  | 66 | _stext: | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 67 | _GLOBAL(__start) | 
|  | 68 | /* NOP this out unconditionally */ | 
|  | 69 | BEGIN_FTR_SECTION | 
| Paul Mackerras | b85a046 | 2005-10-06 10:59:19 +1000 | [diff] [blame] | 70 | b	.__start_initialization_multiplatform | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 71 | END_FTR_SECTION(0, 1) | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 72 |  | 
|  | 73 | /* Catch branch to 0 in real mode */ | 
|  | 74 | trap | 
|  | 75 |  | 
| Paul Mackerras | 1f6a93e | 2008-08-30 11:40:24 +1000 | [diff] [blame] | 76 | /* Secondary processors spin on this value until it becomes nonzero. | 
|  | 77 | * When it does it contains the real address of the descriptor | 
|  | 78 | * of the function that the cpu should jump to to continue | 
|  | 79 | * initialization. | 
|  | 80 | */ | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 81 | .globl  __secondary_hold_spinloop | 
|  | 82 | __secondary_hold_spinloop: | 
|  | 83 | .llong	0x0 | 
|  | 84 |  | 
|  | 85 | /* Secondary processors write this value with their cpu # */ | 
|  | 86 | /* after they enter the spin loop immediately below.	  */ | 
|  | 87 | .globl	__secondary_hold_acknowledge | 
|  | 88 | __secondary_hold_acknowledge: | 
|  | 89 | .llong	0x0 | 
|  | 90 |  | 
| Michael Ellerman | 1dce0e3 | 2006-06-23 18:15:37 +1000 | [diff] [blame] | 91 | #ifdef CONFIG_PPC_ISERIES | 
|  | 92 | /* | 
|  | 93 | * At offset 0x20, there is a pointer to iSeries LPAR data. | 
|  | 94 | * This is required by the hypervisor | 
|  | 95 | */ | 
|  | 96 | . = 0x20 | 
|  | 97 | .llong hvReleaseData-KERNELBASE | 
|  | 98 | #endif /* CONFIG_PPC_ISERIES */ | 
|  | 99 |  | 
| Sonny Rao | 928a319 | 2010-11-18 00:35:07 +0000 | [diff] [blame] | 100 | #ifdef CONFIG_RELOCATABLE | 
| Milton Miller | 8b8b0cc | 2008-10-23 18:41:09 +0000 | [diff] [blame] | 101 | /* This flag is set to 1 by a loader if the kernel should run | 
|  | 102 | * at the loaded address instead of the linked address.  This | 
|  | 103 | * is used by kexec-tools to keep the the kdump kernel in the | 
|  | 104 | * crash_kernel region.  The loader is responsible for | 
|  | 105 | * observing the alignment requirement. | 
|  | 106 | */ | 
|  | 107 | /* Do not move this variable as kexec-tools knows about it. */ | 
|  | 108 | . = 0x5c | 
|  | 109 | .globl	__run_at_load | 
|  | 110 | __run_at_load: | 
|  | 111 | .long	0x72756e30	/* "run0" -- relocate to 0 by default */ | 
|  | 112 | #endif | 
|  | 113 |  | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 114 | . = 0x60 | 
|  | 115 | /* | 
| Geoff Levand | 75423b7 | 2007-06-16 08:06:23 +1000 | [diff] [blame] | 116 | * The following code is used to hold secondary processors | 
|  | 117 | * in a spin loop after they have entered the kernel, but | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 118 | * before the bulk of the kernel has been relocated.  This code | 
|  | 119 | * is relocated to physical address 0x60 before prom_init is run. | 
|  | 120 | * All of it must fit below the first exception vector at 0x100. | 
| Paul Mackerras | 1f6a93e | 2008-08-30 11:40:24 +1000 | [diff] [blame] | 121 | * Use .globl here not _GLOBAL because we want __secondary_hold | 
|  | 122 | * to be the actual text address, not a descriptor. | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 123 | */ | 
| Paul Mackerras | 1f6a93e | 2008-08-30 11:40:24 +1000 | [diff] [blame] | 124 | .globl	__secondary_hold | 
|  | 125 | __secondary_hold: | 
| Benjamin Herrenschmidt | 2d27cfd | 2009-07-23 23:15:59 +0000 | [diff] [blame] | 126 | #ifndef CONFIG_PPC_BOOK3E | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 127 | mfmsr	r24 | 
|  | 128 | ori	r24,r24,MSR_RI | 
|  | 129 | mtmsrd	r24			/* RI on */ | 
| Benjamin Herrenschmidt | 2d27cfd | 2009-07-23 23:15:59 +0000 | [diff] [blame] | 130 | #endif | 
| Anton Blanchard | f1870f7 | 2006-02-13 18:11:13 +1100 | [diff] [blame] | 131 | /* Grab our physical cpu number */ | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 132 | mr	r24,r3 | 
|  | 133 |  | 
|  | 134 | /* Tell the master cpu we're here */ | 
|  | 135 | /* Relocation is off & we are located at an address less */ | 
|  | 136 | /* than 0x100, so only need to grab low order offset.    */ | 
| Paul Mackerras | e31aa45 | 2008-08-30 11:41:12 +1000 | [diff] [blame] | 137 | std	r24,__secondary_hold_acknowledge-_stext(0) | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 138 | sync | 
|  | 139 |  | 
|  | 140 | /* All secondary cpus wait here until told to start. */ | 
| Paul Mackerras | e31aa45 | 2008-08-30 11:41:12 +1000 | [diff] [blame] | 141 | 100:	ld	r4,__secondary_hold_spinloop-_stext(0) | 
| Paul Mackerras | 1f6a93e | 2008-08-30 11:40:24 +1000 | [diff] [blame] | 142 | cmpdi	0,r4,0 | 
|  | 143 | beq	100b | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 144 |  | 
| Anton Blanchard | f1870f7 | 2006-02-13 18:11:13 +1100 | [diff] [blame] | 145 | #if defined(CONFIG_SMP) || defined(CONFIG_KEXEC) | 
| Paul Mackerras | 1f6a93e | 2008-08-30 11:40:24 +1000 | [diff] [blame] | 146 | ld	r4,0(r4)		/* deref function descriptor */ | 
| Michael Ellerman | 758438a | 2005-12-05 15:49:00 -0600 | [diff] [blame] | 147 | mtctr	r4 | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 148 | mr	r3,r24 | 
| Benjamin Herrenschmidt | 2d27cfd | 2009-07-23 23:15:59 +0000 | [diff] [blame] | 149 | li	r4,0 | 
| Benjamin Herrenschmidt | dd79773 | 2011-04-05 14:34:58 +1000 | [diff] [blame] | 150 | /* Make sure that patched code is visible */ | 
|  | 151 | isync | 
| Michael Ellerman | 758438a | 2005-12-05 15:49:00 -0600 | [diff] [blame] | 152 | bctr | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 153 | #else | 
|  | 154 | BUG_OPCODE | 
|  | 155 | #endif | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 156 |  | 
|  | 157 | /* This value is used to mark exception frames on the stack. */ | 
|  | 158 | .section ".toc","aw" | 
|  | 159 | exception_marker: | 
|  | 160 | .tc	ID_72656773_68657265[TC],0x7265677368657265 | 
|  | 161 | .text | 
|  | 162 |  | 
|  | 163 | /* | 
| Benjamin Herrenschmidt | 0ebc4cd | 2009-06-02 21:17:38 +0000 | [diff] [blame] | 164 | * On server, we include the exception vectors code here as it | 
|  | 165 | * relies on absolute addressing which is only possible within | 
|  | 166 | * this compilation unit | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 167 | */ | 
| Benjamin Herrenschmidt | 0ebc4cd | 2009-06-02 21:17:38 +0000 | [diff] [blame] | 168 | #ifdef CONFIG_PPC_BOOK3S | 
|  | 169 | #include "exceptions-64s.S" | 
| Paul Mackerras | 1f6a93e | 2008-08-30 11:40:24 +1000 | [diff] [blame] | 170 | #endif | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 171 |  | 
| Benjamin Herrenschmidt | 2d27cfd | 2009-07-23 23:15:59 +0000 | [diff] [blame] | 172 | _GLOBAL(generic_secondary_thread_init) | 
|  | 173 | mr	r24,r3 | 
|  | 174 |  | 
|  | 175 | /* turn on 64-bit mode */ | 
|  | 176 | bl	.enable_64b_mode | 
|  | 177 |  | 
|  | 178 | /* get a valid TOC pointer, wherever we're mapped at */ | 
|  | 179 | bl	.relative_toc | 
|  | 180 |  | 
|  | 181 | #ifdef CONFIG_PPC_BOOK3E | 
|  | 182 | /* Book3E initialization */ | 
|  | 183 | mr	r3,r24 | 
|  | 184 | bl	.book3e_secondary_thread_init | 
|  | 185 | #endif | 
|  | 186 | b	generic_secondary_common_init | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 187 |  | 
|  | 188 | /* | 
| Olof Johansson | f39b7a5 | 2006-08-11 00:07:08 -0500 | [diff] [blame] | 189 | * On pSeries and most other platforms, secondary processors spin | 
|  | 190 | * in the following code. | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 191 | * At entry, r3 = this processor's number (physical cpu id) | 
| Benjamin Herrenschmidt | 2d27cfd | 2009-07-23 23:15:59 +0000 | [diff] [blame] | 192 | * | 
|  | 193 | * On Book3E, r4 = 1 to indicate that the initial TLB entry for | 
|  | 194 | * this core already exists (setup via some other mechanism such | 
|  | 195 | * as SCOM before entry). | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 196 | */ | 
| Olof Johansson | f39b7a5 | 2006-08-11 00:07:08 -0500 | [diff] [blame] | 197 | _GLOBAL(generic_secondary_smp_init) | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 198 | mr	r24,r3 | 
| Benjamin Herrenschmidt | 2d27cfd | 2009-07-23 23:15:59 +0000 | [diff] [blame] | 199 | mr	r25,r4 | 
|  | 200 |  | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 201 | /* turn on 64-bit mode */ | 
|  | 202 | bl	.enable_64b_mode | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 203 |  | 
| Benjamin Herrenschmidt | 2d27cfd | 2009-07-23 23:15:59 +0000 | [diff] [blame] | 204 | /* get a valid TOC pointer, wherever we're mapped at */ | 
| Paul Mackerras | e31aa45 | 2008-08-30 11:41:12 +1000 | [diff] [blame] | 205 | bl	.relative_toc | 
|  | 206 |  | 
| Benjamin Herrenschmidt | 2d27cfd | 2009-07-23 23:15:59 +0000 | [diff] [blame] | 207 | #ifdef CONFIG_PPC_BOOK3E | 
|  | 208 | /* Book3E initialization */ | 
|  | 209 | mr	r3,r24 | 
|  | 210 | mr	r4,r25 | 
|  | 211 | bl	.book3e_secondary_core_init | 
|  | 212 | #endif | 
|  | 213 |  | 
|  | 214 | generic_secondary_common_init: | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 215 | /* Set up a paca value for this processor. Since we have the | 
|  | 216 | * physical cpu id in r24, we need to search the pacas to find | 
|  | 217 | * which logical id maps to our physical one. | 
|  | 218 | */ | 
| Michael Ellerman | 1426d5a | 2010-01-28 13:23:22 +0000 | [diff] [blame] | 219 | LOAD_REG_ADDR(r13, paca)	/* Load paca pointer		 */ | 
|  | 220 | ld	r13,0(r13)		/* Get base vaddr of paca array	 */ | 
| Milton Miller | 768d18a | 2011-05-10 19:28:37 +0000 | [diff] [blame] | 221 | #ifndef CONFIG_SMP | 
|  | 222 | addi	r13,r13,PACA_SIZE	/* know r13 if used accidentally */ | 
|  | 223 | b	.kexec_wait		/* wait for next kernel if !SMP	 */ | 
|  | 224 | #else | 
|  | 225 | LOAD_REG_ADDR(r7, nr_cpu_ids)	/* Load nr_cpu_ids address       */ | 
|  | 226 | lwz	r7,0(r7)		/* also the max paca allocated 	 */ | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 227 | li	r5,0			/* logical cpu id                */ | 
|  | 228 | 1:	lhz	r6,PACAHWCPUID(r13)	/* Load HW procid from paca      */ | 
|  | 229 | cmpw	r6,r24			/* Compare to our id             */ | 
|  | 230 | beq	2f | 
|  | 231 | addi	r13,r13,PACA_SIZE	/* Loop to next PACA on miss     */ | 
|  | 232 | addi	r5,r5,1 | 
| Milton Miller | 768d18a | 2011-05-10 19:28:37 +0000 | [diff] [blame] | 233 | cmpw	r5,r7			/* Check if more pacas exist     */ | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 234 | blt	1b | 
|  | 235 |  | 
|  | 236 | mr	r3,r24			/* not found, copy phys to r3	 */ | 
|  | 237 | b	.kexec_wait		/* next kernel might do better	 */ | 
|  | 238 |  | 
| Benjamin Herrenschmidt | 2dd60d7 | 2011-01-20 17:50:21 +1100 | [diff] [blame] | 239 | 2:	SET_PACA(r13) | 
| Benjamin Herrenschmidt | 2d27cfd | 2009-07-23 23:15:59 +0000 | [diff] [blame] | 240 | #ifdef CONFIG_PPC_BOOK3E | 
|  | 241 | addi	r12,r13,PACA_EXTLB	/* and TLB exc frame in another  */ | 
|  | 242 | mtspr	SPRN_SPRG_TLB_EXFRAME,r12 | 
|  | 243 | #endif | 
|  | 244 |  | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 245 | /* From now on, r24 is expected to be logical cpuid */ | 
|  | 246 | mr	r24,r5 | 
| Sonny Rao | b6f6b98 | 2008-07-12 09:00:26 +1000 | [diff] [blame] | 247 |  | 
| Olof Johansson | f39b7a5 | 2006-08-11 00:07:08 -0500 | [diff] [blame] | 248 | /* See if we need to call a cpu state restore handler */ | 
| Paul Mackerras | e31aa45 | 2008-08-30 11:41:12 +1000 | [diff] [blame] | 249 | LOAD_REG_ADDR(r23, cur_cpu_spec) | 
| Olof Johansson | f39b7a5 | 2006-08-11 00:07:08 -0500 | [diff] [blame] | 250 | ld	r23,0(r23) | 
|  | 251 | ld	r23,CPU_SPEC_RESTORE(r23) | 
|  | 252 | cmpdi	0,r23,0 | 
| Benjamin Herrenschmidt | 9d07bc8 | 2011-03-16 14:54:35 +1100 | [diff] [blame] | 253 | beq	3f | 
| Olof Johansson | f39b7a5 | 2006-08-11 00:07:08 -0500 | [diff] [blame] | 254 | ld	r23,0(r23) | 
|  | 255 | mtctr	r23 | 
|  | 256 | bctrl | 
|  | 257 |  | 
| Benjamin Herrenschmidt | 9d07bc8 | 2011-03-16 14:54:35 +1100 | [diff] [blame] | 258 | 3:	LOAD_REG_ADDR(r3, boot_cpu_count) /* Decrement boot_cpu_count */ | 
|  | 259 | lwarx	r4,0,r3 | 
|  | 260 | subi	r4,r4,1 | 
|  | 261 | stwcx.	r4,0,r3 | 
|  | 262 | bne	3b | 
|  | 263 | isync | 
|  | 264 |  | 
|  | 265 | 4:	HMT_LOW | 
| Benjamin Herrenschmidt | ad0693e | 2011-02-01 12:13:09 +1100 | [diff] [blame] | 266 | lbz	r23,PACAPROCSTART(r13)	/* Test if this processor should */ | 
|  | 267 | /* start.			 */ | 
| Benjamin Herrenschmidt | ad0693e | 2011-02-01 12:13:09 +1100 | [diff] [blame] | 268 | cmpwi	0,r23,0 | 
| Benjamin Herrenschmidt | 9d07bc8 | 2011-03-16 14:54:35 +1100 | [diff] [blame] | 269 | beq	4b			/* Loop until told to go	 */ | 
| Benjamin Herrenschmidt | ad0693e | 2011-02-01 12:13:09 +1100 | [diff] [blame] | 270 |  | 
|  | 271 | sync				/* order paca.run and cur_cpu_spec */ | 
| Benjamin Herrenschmidt | 9d07bc8 | 2011-03-16 14:54:35 +1100 | [diff] [blame] | 272 | isync				/* In case code patching happened */ | 
| Benjamin Herrenschmidt | ad0693e | 2011-02-01 12:13:09 +1100 | [diff] [blame] | 273 |  | 
| Benjamin Herrenschmidt | 9d07bc8 | 2011-03-16 14:54:35 +1100 | [diff] [blame] | 274 | /* Create a temp kernel stack for use before relocation is on.	*/ | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 275 | ld	r1,PACAEMERGSP(r13) | 
|  | 276 | subi	r1,r1,STACK_FRAME_OVERHEAD | 
|  | 277 |  | 
| Stephen Rothwell | c705677 | 2006-11-27 14:59:50 +1100 | [diff] [blame] | 278 | b	__secondary_start | 
| Milton Miller | 768d18a | 2011-05-10 19:28:37 +0000 | [diff] [blame] | 279 | #endif /* SMP */ | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 280 |  | 
| Paul Mackerras | e31aa45 | 2008-08-30 11:41:12 +1000 | [diff] [blame] | 281 | /* | 
|  | 282 | * Turn the MMU off. | 
|  | 283 | * Assumes we're mapped EA == RA if the MMU is on. | 
|  | 284 | */ | 
| Benjamin Herrenschmidt | 2d27cfd | 2009-07-23 23:15:59 +0000 | [diff] [blame] | 285 | #ifdef CONFIG_PPC_BOOK3S | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 286 | _STATIC(__mmu_off) | 
|  | 287 | mfmsr	r3 | 
|  | 288 | andi.	r0,r3,MSR_IR|MSR_DR | 
|  | 289 | beqlr | 
| Paul Mackerras | e31aa45 | 2008-08-30 11:41:12 +1000 | [diff] [blame] | 290 | mflr	r4 | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 291 | andc	r3,r3,r0 | 
|  | 292 | mtspr	SPRN_SRR0,r4 | 
|  | 293 | mtspr	SPRN_SRR1,r3 | 
|  | 294 | sync | 
|  | 295 | rfid | 
|  | 296 | b	.	/* prevent speculative execution */ | 
| Benjamin Herrenschmidt | 2d27cfd | 2009-07-23 23:15:59 +0000 | [diff] [blame] | 297 | #endif | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 298 |  | 
|  | 299 |  | 
|  | 300 | /* | 
|  | 301 | * Here is our main kernel entry point. We support currently 2 kind of entries | 
|  | 302 | * depending on the value of r5. | 
|  | 303 | * | 
|  | 304 | *   r5 != NULL -> OF entry, we go to prom_init, "legacy" parameter content | 
|  | 305 | *                 in r3...r7 | 
|  | 306 | * | 
|  | 307 | *   r5 == NULL -> kexec style entry. r3 is a physical pointer to the | 
|  | 308 | *                 DT block, r4 is a physical pointer to the kernel itself | 
|  | 309 | * | 
|  | 310 | */ | 
|  | 311 | _GLOBAL(__start_initialization_multiplatform) | 
| Paul Mackerras | e31aa45 | 2008-08-30 11:41:12 +1000 | [diff] [blame] | 312 | /* Make sure we are running in 64 bits mode */ | 
|  | 313 | bl	.enable_64b_mode | 
|  | 314 |  | 
|  | 315 | /* Get TOC pointer (current runtime address) */ | 
|  | 316 | bl	.relative_toc | 
|  | 317 |  | 
|  | 318 | /* find out where we are now */ | 
|  | 319 | bcl	20,31,$+4 | 
|  | 320 | 0:	mflr	r26			/* r26 = runtime addr here */ | 
|  | 321 | addis	r26,r26,(_stext - 0b)@ha | 
|  | 322 | addi	r26,r26,(_stext - 0b)@l	/* current runtime base addr */ | 
|  | 323 |  | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 324 | /* | 
|  | 325 | * Are we booted from a PROM Of-type client-interface ? | 
|  | 326 | */ | 
|  | 327 | cmpldi	cr0,r5,0 | 
| Stephen Rothwell | 939e60f6 | 2007-07-31 16:44:13 +1000 | [diff] [blame] | 328 | beq	1f | 
|  | 329 | b	.__boot_from_prom		/* yes -> prom */ | 
|  | 330 | 1: | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 331 | /* Save parameters */ | 
|  | 332 | mr	r31,r3 | 
|  | 333 | mr	r30,r4 | 
|  | 334 |  | 
| Benjamin Herrenschmidt | 2d27cfd | 2009-07-23 23:15:59 +0000 | [diff] [blame] | 335 | #ifdef CONFIG_PPC_BOOK3E | 
|  | 336 | bl	.start_initialization_book3e | 
|  | 337 | b	.__after_prom_start | 
|  | 338 | #else | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 339 | /* Setup some critical 970 SPRs before switching MMU off */ | 
| Olof Johansson | f39b7a5 | 2006-08-11 00:07:08 -0500 | [diff] [blame] | 340 | mfspr	r0,SPRN_PVR | 
|  | 341 | srwi	r0,r0,16 | 
|  | 342 | cmpwi	r0,0x39		/* 970 */ | 
|  | 343 | beq	1f | 
|  | 344 | cmpwi	r0,0x3c		/* 970FX */ | 
|  | 345 | beq	1f | 
|  | 346 | cmpwi	r0,0x44		/* 970MP */ | 
| Olof Johansson | 190a24f | 2006-10-25 17:32:40 -0500 | [diff] [blame] | 347 | beq	1f | 
|  | 348 | cmpwi	r0,0x45		/* 970GX */ | 
| Olof Johansson | f39b7a5 | 2006-08-11 00:07:08 -0500 | [diff] [blame] | 349 | bne	2f | 
|  | 350 | 1:	bl	.__cpu_preinit_ppc970 | 
|  | 351 | 2: | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 352 |  | 
| Paul Mackerras | e31aa45 | 2008-08-30 11:41:12 +1000 | [diff] [blame] | 353 | /* Switch off MMU if not already off */ | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 354 | bl	.__mmu_off | 
|  | 355 | b	.__after_prom_start | 
| Benjamin Herrenschmidt | 2d27cfd | 2009-07-23 23:15:59 +0000 | [diff] [blame] | 356 | #endif /* CONFIG_PPC_BOOK3E */ | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 357 |  | 
| Stephen Rothwell | 939e60f6 | 2007-07-31 16:44:13 +1000 | [diff] [blame] | 358 | _INIT_STATIC(__boot_from_prom) | 
| Benjamin Herrenschmidt | 28794d3 | 2009-03-10 17:53:27 +0000 | [diff] [blame] | 359 | #ifdef CONFIG_PPC_OF_BOOT_TRAMPOLINE | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 360 | /* Save parameters */ | 
|  | 361 | mr	r31,r3 | 
|  | 362 | mr	r30,r4 | 
|  | 363 | mr	r29,r5 | 
|  | 364 | mr	r28,r6 | 
|  | 365 | mr	r27,r7 | 
|  | 366 |  | 
| Olaf Hering | 6088857 | 2006-03-23 21:50:59 +0100 | [diff] [blame] | 367 | /* | 
|  | 368 | * Align the stack to 16-byte boundary | 
|  | 369 | * Depending on the size and layout of the ELF sections in the initial | 
| Paul Mackerras | e31aa45 | 2008-08-30 11:41:12 +1000 | [diff] [blame] | 370 | * boot binary, the stack pointer may be unaligned on PowerMac | 
| Olaf Hering | 6088857 | 2006-03-23 21:50:59 +0100 | [diff] [blame] | 371 | */ | 
| Linus Torvalds | c05b477 | 2006-03-04 15:00:45 -0800 | [diff] [blame] | 372 | rldicr	r1,r1,0,59 | 
|  | 373 |  | 
| Paul Mackerras | 549e815 | 2008-08-30 11:43:47 +1000 | [diff] [blame] | 374 | #ifdef CONFIG_RELOCATABLE | 
|  | 375 | /* Relocate code for where we are now */ | 
|  | 376 | mr	r3,r26 | 
|  | 377 | bl	.relocate | 
|  | 378 | #endif | 
|  | 379 |  | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 380 | /* Restore parameters */ | 
|  | 381 | mr	r3,r31 | 
|  | 382 | mr	r4,r30 | 
|  | 383 | mr	r5,r29 | 
|  | 384 | mr	r6,r28 | 
|  | 385 | mr	r7,r27 | 
|  | 386 |  | 
|  | 387 | /* Do all of the interaction with OF client interface */ | 
| Paul Mackerras | 549e815 | 2008-08-30 11:43:47 +1000 | [diff] [blame] | 388 | mr	r8,r26 | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 389 | bl	.prom_init | 
| Benjamin Herrenschmidt | 28794d3 | 2009-03-10 17:53:27 +0000 | [diff] [blame] | 390 | #endif /* #CONFIG_PPC_OF_BOOT_TRAMPOLINE */ | 
|  | 391 |  | 
|  | 392 | /* We never return. We also hit that trap if trying to boot | 
|  | 393 | * from OF while CONFIG_PPC_OF_BOOT_TRAMPOLINE isn't selected */ | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 394 | trap | 
|  | 395 |  | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 396 | _STATIC(__after_prom_start) | 
| Paul Mackerras | 549e815 | 2008-08-30 11:43:47 +1000 | [diff] [blame] | 397 | #ifdef CONFIG_RELOCATABLE | 
|  | 398 | /* process relocations for the final address of the kernel */ | 
|  | 399 | lis	r25,PAGE_OFFSET@highest	/* compute virtual base of kernel */ | 
|  | 400 | sldi	r25,r25,32 | 
| Milton Miller | 8b8b0cc | 2008-10-23 18:41:09 +0000 | [diff] [blame] | 401 | lwz	r7,__run_at_load-_stext(r26) | 
| Sonny Rao | 928a319 | 2010-11-18 00:35:07 +0000 | [diff] [blame] | 402 | cmplwi	cr0,r7,1	/* flagged to stay where we are ? */ | 
| Mohan Kumar M | 54622f1 | 2008-10-21 17:38:10 +0000 | [diff] [blame] | 403 | bne	1f | 
|  | 404 | add	r25,r25,r26 | 
| Mohan Kumar M | 54622f1 | 2008-10-21 17:38:10 +0000 | [diff] [blame] | 405 | 1:	mr	r3,r25 | 
| Paul Mackerras | 549e815 | 2008-08-30 11:43:47 +1000 | [diff] [blame] | 406 | bl	.relocate | 
|  | 407 | #endif | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 408 |  | 
|  | 409 | /* | 
| Paul Mackerras | e31aa45 | 2008-08-30 11:41:12 +1000 | [diff] [blame] | 410 | * We need to run with _stext at physical address PHYSICAL_START. | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 411 | * This will leave some code in the first 256B of | 
|  | 412 | * real memory, which are reserved for software use. | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 413 | * | 
|  | 414 | * Note: This process overwrites the OF exception vectors. | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 415 | */ | 
| Paul Mackerras | 549e815 | 2008-08-30 11:43:47 +1000 | [diff] [blame] | 416 | li	r3,0			/* target addr */ | 
| Benjamin Herrenschmidt | 2d27cfd | 2009-07-23 23:15:59 +0000 | [diff] [blame] | 417 | #ifdef CONFIG_PPC_BOOK3E | 
|  | 418 | tovirt(r3,r3)			/* on booke, we already run at PAGE_OFFSET */ | 
|  | 419 | #endif | 
| Paul Mackerras | 549e815 | 2008-08-30 11:43:47 +1000 | [diff] [blame] | 420 | mr.	r4,r26			/* In some cases the loader may  */ | 
| Paul Mackerras | e31aa45 | 2008-08-30 11:41:12 +1000 | [diff] [blame] | 421 | beq	9f			/* have already put us at zero */ | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 422 | li	r6,0x100		/* Start offset, the first 0x100 */ | 
|  | 423 | /* bytes were copied earlier.	 */ | 
| Benjamin Herrenschmidt | 2d27cfd | 2009-07-23 23:15:59 +0000 | [diff] [blame] | 424 | #ifdef CONFIG_PPC_BOOK3E | 
|  | 425 | tovirt(r6,r6)			/* on booke, we already run at PAGE_OFFSET */ | 
|  | 426 | #endif | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 427 |  | 
| Mohan Kumar M | 54622f1 | 2008-10-21 17:38:10 +0000 | [diff] [blame] | 428 | #ifdef CONFIG_CRASH_DUMP | 
|  | 429 | /* | 
|  | 430 | * Check if the kernel has to be running as relocatable kernel based on the | 
| Milton Miller | 8b8b0cc | 2008-10-23 18:41:09 +0000 | [diff] [blame] | 431 | * variable __run_at_load, if it is set the kernel is treated as relocatable | 
| Mohan Kumar M | 54622f1 | 2008-10-21 17:38:10 +0000 | [diff] [blame] | 432 | * kernel, otherwise it will be moved to PHYSICAL_START | 
|  | 433 | */ | 
| Milton Miller | 8b8b0cc | 2008-10-23 18:41:09 +0000 | [diff] [blame] | 434 | lwz	r7,__run_at_load-_stext(r26) | 
|  | 435 | cmplwi	cr0,r7,1 | 
| Mohan Kumar M | 54622f1 | 2008-10-21 17:38:10 +0000 | [diff] [blame] | 436 | bne	3f | 
|  | 437 |  | 
|  | 438 | li	r5,__end_interrupts - _stext	/* just copy interrupts */ | 
|  | 439 | b	5f | 
|  | 440 | 3: | 
|  | 441 | #endif | 
|  | 442 | lis	r5,(copy_to_here - _stext)@ha | 
|  | 443 | addi	r5,r5,(copy_to_here - _stext)@l /* # bytes of memory to copy */ | 
|  | 444 |  | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 445 | bl	.copy_and_flush		/* copy the first n bytes	 */ | 
|  | 446 | /* this includes the code being	 */ | 
|  | 447 | /* executed here.		 */ | 
| Paul Mackerras | e31aa45 | 2008-08-30 11:41:12 +1000 | [diff] [blame] | 448 | addis	r8,r3,(4f - _stext)@ha	/* Jump to the copy of this code */ | 
|  | 449 | addi	r8,r8,(4f - _stext)@l	/* that we just made */ | 
|  | 450 | mtctr	r8 | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 451 | bctr | 
|  | 452 |  | 
| Mohan Kumar M | 54622f1 | 2008-10-21 17:38:10 +0000 | [diff] [blame] | 453 | p_end:	.llong	_end - _stext | 
|  | 454 |  | 
| Paul Mackerras | e31aa45 | 2008-08-30 11:41:12 +1000 | [diff] [blame] | 455 | 4:	/* Now copy the rest of the kernel up to _end */ | 
|  | 456 | addis	r5,r26,(p_end - _stext)@ha | 
|  | 457 | ld	r5,(p_end - _stext)@l(r5)	/* get _end */ | 
| Mohan Kumar M | 54622f1 | 2008-10-21 17:38:10 +0000 | [diff] [blame] | 458 | 5:	bl	.copy_and_flush		/* copy the rest */ | 
| Paul Mackerras | e31aa45 | 2008-08-30 11:41:12 +1000 | [diff] [blame] | 459 |  | 
|  | 460 | 9:	b	.start_here_multiplatform | 
|  | 461 |  | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 462 | /* | 
|  | 463 | * Copy routine used to copy the kernel to start at physical address 0 | 
|  | 464 | * and flush and invalidate the caches as needed. | 
|  | 465 | * r3 = dest addr, r4 = source addr, r5 = copy limit, r6 = start offset | 
|  | 466 | * on exit, r3, r4, r5 are unchanged, r6 is updated to be >= r5. | 
|  | 467 | * | 
|  | 468 | * Note: this routine *only* clobbers r0, r6 and lr | 
|  | 469 | */ | 
|  | 470 | _GLOBAL(copy_and_flush) | 
|  | 471 | addi	r5,r5,-8 | 
|  | 472 | addi	r6,r6,-8 | 
| Olof Johansson | 5a2fe38 | 2006-09-06 14:34:41 -0500 | [diff] [blame] | 473 | 4:	li	r0,8			/* Use the smallest common	*/ | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 474 | /* denominator cache line	*/ | 
|  | 475 | /* size.  This results in	*/ | 
|  | 476 | /* extra cache line flushes	*/ | 
|  | 477 | /* but operation is correct.	*/ | 
|  | 478 | /* Can't get cache line size	*/ | 
|  | 479 | /* from NACA as it is being	*/ | 
|  | 480 | /* moved too.			*/ | 
|  | 481 |  | 
|  | 482 | mtctr	r0			/* put # words/line in ctr	*/ | 
|  | 483 | 3:	addi	r6,r6,8			/* copy a cache line		*/ | 
|  | 484 | ldx	r0,r6,r4 | 
|  | 485 | stdx	r0,r6,r3 | 
|  | 486 | bdnz	3b | 
|  | 487 | dcbst	r6,r3			/* write it to memory		*/ | 
|  | 488 | sync | 
|  | 489 | icbi	r6,r3			/* flush the icache line	*/ | 
|  | 490 | cmpld	0,r6,r5 | 
|  | 491 | blt	4b | 
|  | 492 | sync | 
|  | 493 | addi	r5,r5,8 | 
|  | 494 | addi	r6,r6,8 | 
|  | 495 | blr | 
|  | 496 |  | 
|  | 497 | .align 8 | 
|  | 498 | copy_to_here: | 
|  | 499 |  | 
|  | 500 | #ifdef CONFIG_SMP | 
|  | 501 | #ifdef CONFIG_PPC_PMAC | 
|  | 502 | /* | 
|  | 503 | * On PowerMac, secondary processors starts from the reset vector, which | 
|  | 504 | * is temporarily turned into a call to one of the functions below. | 
|  | 505 | */ | 
|  | 506 | .section ".text"; | 
|  | 507 | .align 2 ; | 
|  | 508 |  | 
| Paul Mackerras | 35499c0 | 2005-10-22 16:02:39 +1000 | [diff] [blame] | 509 | .globl	__secondary_start_pmac_0 | 
|  | 510 | __secondary_start_pmac_0: | 
|  | 511 | /* NB the entries for cpus 0, 1, 2 must each occupy 8 bytes. */ | 
|  | 512 | li	r24,0 | 
|  | 513 | b	1f | 
|  | 514 | li	r24,1 | 
|  | 515 | b	1f | 
|  | 516 | li	r24,2 | 
|  | 517 | b	1f | 
|  | 518 | li	r24,3 | 
|  | 519 | 1: | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 520 |  | 
|  | 521 | _GLOBAL(pmac_secondary_start) | 
|  | 522 | /* turn on 64-bit mode */ | 
|  | 523 | bl	.enable_64b_mode | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 524 |  | 
| Benjamin Herrenschmidt | c478b58 | 2009-01-11 19:03:45 +0000 | [diff] [blame] | 525 | li	r0,0 | 
|  | 526 | mfspr	r3,SPRN_HID4 | 
|  | 527 | rldimi	r3,r0,40,23	/* clear bit 23 (rm_ci) */ | 
|  | 528 | sync | 
|  | 529 | mtspr	SPRN_HID4,r3 | 
|  | 530 | isync | 
|  | 531 | sync | 
|  | 532 | slbia | 
|  | 533 |  | 
| Paul Mackerras | e31aa45 | 2008-08-30 11:41:12 +1000 | [diff] [blame] | 534 | /* get TOC pointer (real address) */ | 
|  | 535 | bl	.relative_toc | 
|  | 536 |  | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 537 | /* Copy some CPU settings from CPU 0 */ | 
| Olof Johansson | f39b7a5 | 2006-08-11 00:07:08 -0500 | [diff] [blame] | 538 | bl	.__restore_cpu_ppc970 | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 539 |  | 
|  | 540 | /* pSeries do that early though I don't think we really need it */ | 
|  | 541 | mfmsr	r3 | 
|  | 542 | ori	r3,r3,MSR_RI | 
|  | 543 | mtmsrd	r3			/* RI on */ | 
|  | 544 |  | 
|  | 545 | /* Set up a paca value for this processor. */ | 
| Michael Ellerman | 1426d5a | 2010-01-28 13:23:22 +0000 | [diff] [blame] | 546 | LOAD_REG_ADDR(r4,paca)		/* Load paca pointer		*/ | 
|  | 547 | ld	r4,0(r4)		/* Get base vaddr of paca array	*/ | 
| Paul Mackerras | e31aa45 | 2008-08-30 11:41:12 +1000 | [diff] [blame] | 548 | mulli	r13,r24,PACA_SIZE	/* Calculate vaddr of right paca */ | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 549 | add	r13,r13,r4		/* for this processor.		*/ | 
| Benjamin Herrenschmidt | 2dd60d7 | 2011-01-20 17:50:21 +1100 | [diff] [blame] | 550 | SET_PACA(r13)			/* Save vaddr of paca in an SPRG*/ | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 551 |  | 
| Benjamin Herrenschmidt | 62cc67b | 2011-02-21 16:49:58 +1100 | [diff] [blame] | 552 | /* Mark interrupts soft and hard disabled (they might be enabled | 
|  | 553 | * in the PACA when doing hotplug) | 
|  | 554 | */ | 
|  | 555 | li	r0,0 | 
|  | 556 | stb	r0,PACASOFTIRQEN(r13) | 
|  | 557 | stb	r0,PACAHARDIRQEN(r13) | 
|  | 558 |  | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 559 | /* Create a temp kernel stack for use before relocation is on.	*/ | 
|  | 560 | ld	r1,PACAEMERGSP(r13) | 
|  | 561 | subi	r1,r1,STACK_FRAME_OVERHEAD | 
|  | 562 |  | 
| Stephen Rothwell | c705677 | 2006-11-27 14:59:50 +1100 | [diff] [blame] | 563 | b	__secondary_start | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 564 |  | 
|  | 565 | #endif /* CONFIG_PPC_PMAC */ | 
|  | 566 |  | 
|  | 567 | /* | 
|  | 568 | * This function is called after the master CPU has released the | 
|  | 569 | * secondary processors.  The execution environment is relocation off. | 
|  | 570 | * The paca for this processor has the following fields initialized at | 
|  | 571 | * this point: | 
|  | 572 | *   1. Processor number | 
|  | 573 | *   2. Segment table pointer (virtual address) | 
|  | 574 | * On entry the following are set: | 
| Benjamin Herrenschmidt | ee43eb7 | 2009-07-14 20:52:54 +0000 | [diff] [blame] | 575 | *   r1	       = stack pointer.  vaddr for iSeries, raddr (temp stack) for pSeries | 
|  | 576 | *   r24       = cpu# (in Linux terms) | 
|  | 577 | *   r13       = paca virtual address | 
|  | 578 | *   SPRG_PACA = paca virtual address | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 579 | */ | 
| Benjamin Herrenschmidt | 2d27cfd | 2009-07-23 23:15:59 +0000 | [diff] [blame] | 580 | .section ".text"; | 
|  | 581 | .align 2 ; | 
|  | 582 |  | 
| Stephen Rothwell | fc68e86 | 2007-08-22 13:44:58 +1000 | [diff] [blame] | 583 | .globl	__secondary_start | 
| Stephen Rothwell | c705677 | 2006-11-27 14:59:50 +1100 | [diff] [blame] | 584 | __secondary_start: | 
| Paul Mackerras | 799d604 | 2005-11-10 13:37:51 +1100 | [diff] [blame] | 585 | /* Set thread priority to MEDIUM */ | 
|  | 586 | HMT_MEDIUM | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 587 |  | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 588 | /* Initialize the kernel stack.  Just a repeat for iSeries.	 */ | 
| David Gibson | e58c349 | 2006-01-13 14:56:25 +1100 | [diff] [blame] | 589 | LOAD_REG_ADDR(r3, current_set) | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 590 | sldi	r28,r24,3		/* get current_set[cpu#]	 */ | 
| Michael Neuling | 54a8340 | 2010-08-25 21:04:25 +0000 | [diff] [blame] | 591 | ldx	r14,r3,r28 | 
|  | 592 | addi	r14,r14,THREAD_SIZE-STACK_FRAME_OVERHEAD | 
|  | 593 | std	r14,PACAKSAVE(r13) | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 594 |  | 
| Matt Evans | f761622 | 2010-08-12 20:58:28 +0000 | [diff] [blame] | 595 | /* Do early setup for that CPU (stab, slb, hash table pointer) */ | 
|  | 596 | bl	.early_setup_secondary | 
|  | 597 |  | 
| Michael Neuling | 54a8340 | 2010-08-25 21:04:25 +0000 | [diff] [blame] | 598 | /* | 
|  | 599 | * setup the new stack pointer, but *don't* use this until | 
|  | 600 | * translation is on. | 
|  | 601 | */ | 
|  | 602 | mr	r1, r14 | 
|  | 603 |  | 
| Paul Mackerras | 799d604 | 2005-11-10 13:37:51 +1100 | [diff] [blame] | 604 | /* Clear backchain so we get nice backtraces */ | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 605 | li	r7,0 | 
|  | 606 | mtlr	r7 | 
|  | 607 |  | 
|  | 608 | /* enable MMU and jump to start_secondary */ | 
| David Gibson | e58c349 | 2006-01-13 14:56:25 +1100 | [diff] [blame] | 609 | LOAD_REG_ADDR(r3, .start_secondary_prolog) | 
|  | 610 | LOAD_REG_IMMEDIATE(r4, MSR_KERNEL) | 
| Paul Mackerras | d04c56f | 2006-10-04 16:47:49 +1000 | [diff] [blame] | 611 | #ifdef CONFIG_PPC_ISERIES | 
| Stephen Rothwell | 3f639ee | 2006-09-25 18:19:00 +1000 | [diff] [blame] | 612 | BEGIN_FW_FTR_SECTION | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 613 | ori	r4,r4,MSR_EE | 
| Benjamin Herrenschmidt | ff3da2e | 2008-04-02 15:58:40 +1100 | [diff] [blame] | 614 | li	r8,1 | 
|  | 615 | stb	r8,PACAHARDIRQEN(r13) | 
| Stephen Rothwell | 3f639ee | 2006-09-25 18:19:00 +1000 | [diff] [blame] | 616 | END_FW_FTR_SECTION_IFSET(FW_FEATURE_ISERIES) | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 617 | #endif | 
| Paul Mackerras | d04c56f | 2006-10-04 16:47:49 +1000 | [diff] [blame] | 618 | BEGIN_FW_FTR_SECTION | 
| Paul Mackerras | d04c56f | 2006-10-04 16:47:49 +1000 | [diff] [blame] | 619 | stb	r7,PACAHARDIRQEN(r13) | 
|  | 620 | END_FW_FTR_SECTION_IFCLR(FW_FEATURE_ISERIES) | 
| Benjamin Herrenschmidt | ff3da2e | 2008-04-02 15:58:40 +1100 | [diff] [blame] | 621 | stb	r7,PACASOFTIRQEN(r13) | 
| Paul Mackerras | d04c56f | 2006-10-04 16:47:49 +1000 | [diff] [blame] | 622 |  | 
| Paul Mackerras | b5bbeb2 | 2005-10-10 14:01:07 +1000 | [diff] [blame] | 623 | mtspr	SPRN_SRR0,r3 | 
|  | 624 | mtspr	SPRN_SRR1,r4 | 
| Benjamin Herrenschmidt | 2d27cfd | 2009-07-23 23:15:59 +0000 | [diff] [blame] | 625 | RFI | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 626 | b	.	/* prevent speculative execution */ | 
|  | 627 |  | 
|  | 628 | /* | 
|  | 629 | * Running with relocation on at this point.  All we want to do is | 
| Paul Mackerras | e31aa45 | 2008-08-30 11:41:12 +1000 | [diff] [blame] | 630 | * zero the stack back-chain pointer and get the TOC virtual address | 
|  | 631 | * before going into C code. | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 632 | */ | 
|  | 633 | _GLOBAL(start_secondary_prolog) | 
| Paul Mackerras | e31aa45 | 2008-08-30 11:41:12 +1000 | [diff] [blame] | 634 | ld	r2,PACATOC(r13) | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 635 | li	r3,0 | 
|  | 636 | std	r3,0(r1)		/* Zero the stack frame pointer	*/ | 
|  | 637 | bl	.start_secondary | 
| Paul Mackerras | 799d604 | 2005-11-10 13:37:51 +1100 | [diff] [blame] | 638 | b	. | 
| Vaidyanathan Srinivasan | 8dbce53 | 2010-03-01 02:58:09 +0000 | [diff] [blame] | 639 | /* | 
|  | 640 | * Reset stack pointer and call start_secondary | 
|  | 641 | * to continue with online operation when woken up | 
|  | 642 | * from cede in cpu offline. | 
|  | 643 | */ | 
|  | 644 | _GLOBAL(start_secondary_resume) | 
|  | 645 | ld	r1,PACAKSAVE(r13)	/* Reload kernel stack pointer */ | 
|  | 646 | li	r3,0 | 
|  | 647 | std	r3,0(r1)		/* Zero the stack frame pointer	*/ | 
|  | 648 | bl	.start_secondary | 
|  | 649 | b	. | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 650 | #endif | 
|  | 651 |  | 
|  | 652 | /* | 
|  | 653 | * This subroutine clobbers r11 and r12 | 
|  | 654 | */ | 
|  | 655 | _GLOBAL(enable_64b_mode) | 
|  | 656 | mfmsr	r11			/* grab the current MSR */ | 
| Benjamin Herrenschmidt | 2d27cfd | 2009-07-23 23:15:59 +0000 | [diff] [blame] | 657 | #ifdef CONFIG_PPC_BOOK3E | 
|  | 658 | oris	r11,r11,0x8000		/* CM bit set, we'll set ICM later */ | 
|  | 659 | mtmsr	r11 | 
|  | 660 | #else /* CONFIG_PPC_BOOK3E */ | 
| Michael Ellerman | 9f0b079 | 2011-04-07 21:56:03 +0000 | [diff] [blame] | 661 | li	r12,(MSR_64BIT | MSR_ISF)@highest | 
| Paul Mackerras | e31aa45 | 2008-08-30 11:41:12 +1000 | [diff] [blame] | 662 | sldi	r12,r12,48 | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 663 | or	r11,r11,r12 | 
|  | 664 | mtmsrd	r11 | 
|  | 665 | isync | 
| Benjamin Herrenschmidt | 2d27cfd | 2009-07-23 23:15:59 +0000 | [diff] [blame] | 666 | #endif | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 667 | blr | 
|  | 668 |  | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 669 | /* | 
| Paul Mackerras | e31aa45 | 2008-08-30 11:41:12 +1000 | [diff] [blame] | 670 | * This puts the TOC pointer into r2, offset by 0x8000 (as expected | 
|  | 671 | * by the toolchain).  It computes the correct value for wherever we | 
|  | 672 | * are running at the moment, using position-independent code. | 
|  | 673 | */ | 
|  | 674 | _GLOBAL(relative_toc) | 
|  | 675 | mflr	r0 | 
|  | 676 | bcl	20,31,$+4 | 
|  | 677 | 0:	mflr	r9 | 
|  | 678 | ld	r2,(p_toc - 0b)(r9) | 
|  | 679 | add	r2,r2,r9 | 
|  | 680 | mtlr	r0 | 
|  | 681 | blr | 
|  | 682 |  | 
|  | 683 | p_toc:	.llong	__toc_start + 0x8000 - 0b | 
|  | 684 |  | 
|  | 685 | /* | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 686 | * This is where the main kernel code starts. | 
|  | 687 | */ | 
| Stephen Rothwell | 939e60f6 | 2007-07-31 16:44:13 +1000 | [diff] [blame] | 688 | _INIT_STATIC(start_here_multiplatform) | 
| Paul Mackerras | e31aa45 | 2008-08-30 11:41:12 +1000 | [diff] [blame] | 689 | /* set up the TOC (real address) */ | 
|  | 690 | bl	.relative_toc | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 691 |  | 
|  | 692 | /* Clear out the BSS. It may have been done in prom_init, | 
|  | 693 | * already but that's irrelevant since prom_init will soon | 
|  | 694 | * be detached from the kernel completely. Besides, we need | 
|  | 695 | * to clear it now for kexec-style entry. | 
|  | 696 | */ | 
| Paul Mackerras | e31aa45 | 2008-08-30 11:41:12 +1000 | [diff] [blame] | 697 | LOAD_REG_ADDR(r11,__bss_stop) | 
|  | 698 | LOAD_REG_ADDR(r8,__bss_start) | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 699 | sub	r11,r11,r8		/* bss size			*/ | 
|  | 700 | addi	r11,r11,7		/* round up to an even double word */ | 
| Paul Mackerras | e31aa45 | 2008-08-30 11:41:12 +1000 | [diff] [blame] | 701 | srdi.	r11,r11,3		/* shift right by 3		*/ | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 702 | beq	4f | 
|  | 703 | addi	r8,r8,-8 | 
|  | 704 | li	r0,0 | 
|  | 705 | mtctr	r11			/* zero this many doublewords	*/ | 
|  | 706 | 3:	stdu	r0,8(r8) | 
|  | 707 | bdnz	3b | 
|  | 708 | 4: | 
|  | 709 |  | 
| Benjamin Herrenschmidt | 2d27cfd | 2009-07-23 23:15:59 +0000 | [diff] [blame] | 710 | #ifndef CONFIG_PPC_BOOK3E | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 711 | mfmsr	r6 | 
|  | 712 | ori	r6,r6,MSR_RI | 
|  | 713 | mtmsrd	r6			/* RI on */ | 
| Benjamin Herrenschmidt | 2d27cfd | 2009-07-23 23:15:59 +0000 | [diff] [blame] | 714 | #endif | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 715 |  | 
| Paul Mackerras | 549e815 | 2008-08-30 11:43:47 +1000 | [diff] [blame] | 716 | #ifdef CONFIG_RELOCATABLE | 
|  | 717 | /* Save the physical address we're running at in kernstart_addr */ | 
|  | 718 | LOAD_REG_ADDR(r4, kernstart_addr) | 
|  | 719 | clrldi	r0,r25,2 | 
|  | 720 | std	r0,0(r4) | 
|  | 721 | #endif | 
|  | 722 |  | 
| Paul Mackerras | e31aa45 | 2008-08-30 11:41:12 +1000 | [diff] [blame] | 723 | /* The following gets the stack set up with the regs */ | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 724 | /* pointing to the real addr of the kernel stack.  This is   */ | 
|  | 725 | /* all done to support the C function call below which sets  */ | 
|  | 726 | /* up the htab.  This is done because we have relocated the  */ | 
|  | 727 | /* kernel but are still running in real mode. */ | 
|  | 728 |  | 
| Paul Mackerras | e31aa45 | 2008-08-30 11:41:12 +1000 | [diff] [blame] | 729 | LOAD_REG_ADDR(r3,init_thread_union) | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 730 |  | 
| Paul Mackerras | e31aa45 | 2008-08-30 11:41:12 +1000 | [diff] [blame] | 731 | /* set up a stack pointer */ | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 732 | addi	r1,r3,THREAD_SIZE | 
|  | 733 | li	r0,0 | 
|  | 734 | stdu	r0,-STACK_FRAME_OVERHEAD(r1) | 
|  | 735 |  | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 736 | /* Do very early kernel initializations, including initial hash table, | 
|  | 737 | * stab and slb setup before we turn on relocation.	*/ | 
|  | 738 |  | 
|  | 739 | /* Restore parameters passed from prom_init/kexec */ | 
|  | 740 | mr	r3,r31 | 
| Benjamin Herrenschmidt | ee43eb7 | 2009-07-14 20:52:54 +0000 | [diff] [blame] | 741 | bl	.early_setup		/* also sets r13 and SPRG_PACA */ | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 742 |  | 
| Paul Mackerras | e31aa45 | 2008-08-30 11:41:12 +1000 | [diff] [blame] | 743 | LOAD_REG_ADDR(r3, .start_here_common) | 
|  | 744 | ld	r4,PACAKMSR(r13) | 
| Paul Mackerras | b5bbeb2 | 2005-10-10 14:01:07 +1000 | [diff] [blame] | 745 | mtspr	SPRN_SRR0,r3 | 
|  | 746 | mtspr	SPRN_SRR1,r4 | 
| Benjamin Herrenschmidt | 2d27cfd | 2009-07-23 23:15:59 +0000 | [diff] [blame] | 747 | RFI | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 748 | b	.	/* prevent speculative execution */ | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 749 |  | 
|  | 750 | /* This is where all platforms converge execution */ | 
| Stephen Rothwell | fc68e86 | 2007-08-22 13:44:58 +1000 | [diff] [blame] | 751 | _INIT_GLOBAL(start_here_common) | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 752 | /* relocation is on at this point */ | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 753 | std	r1,PACAKSAVE(r13) | 
|  | 754 |  | 
| Paul Mackerras | e31aa45 | 2008-08-30 11:41:12 +1000 | [diff] [blame] | 755 | /* Load the TOC (virtual address) */ | 
|  | 756 | ld	r2,PACATOC(r13) | 
|  | 757 |  | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 758 | bl	.setup_system | 
|  | 759 |  | 
|  | 760 | /* Load up the kernel context */ | 
|  | 761 | 5: | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 762 | li	r5,0 | 
| Paul Mackerras | d04c56f | 2006-10-04 16:47:49 +1000 | [diff] [blame] | 763 | stb	r5,PACASOFTIRQEN(r13)	/* Soft Disabled */ | 
|  | 764 | #ifdef CONFIG_PPC_ISERIES | 
|  | 765 | BEGIN_FW_FTR_SECTION | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 766 | mfmsr	r5 | 
| Benjamin Herrenschmidt | ff3da2e | 2008-04-02 15:58:40 +1100 | [diff] [blame] | 767 | ori	r5,r5,MSR_EE		/* Hard Enabled on iSeries*/ | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 768 | mtmsrd	r5 | 
| Benjamin Herrenschmidt | ff3da2e | 2008-04-02 15:58:40 +1100 | [diff] [blame] | 769 | li	r5,1 | 
| Stephen Rothwell | 3f639ee | 2006-09-25 18:19:00 +1000 | [diff] [blame] | 770 | END_FW_FTR_SECTION_IFSET(FW_FEATURE_ISERIES) | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 771 | #endif | 
| Benjamin Herrenschmidt | ff3da2e | 2008-04-02 15:58:40 +1100 | [diff] [blame] | 772 | stb	r5,PACAHARDIRQEN(r13)	/* Hard Disabled on others */ | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 773 |  | 
| Benjamin Herrenschmidt | ff3da2e | 2008-04-02 15:58:40 +1100 | [diff] [blame] | 774 | bl	.start_kernel | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 775 |  | 
| Anton Blanchard | f1870f7 | 2006-02-13 18:11:13 +1100 | [diff] [blame] | 776 | /* Not reached */ | 
|  | 777 | BUG_OPCODE | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 778 |  | 
| Paul Mackerras | 14cf11a | 2005-09-26 16:04:21 +1000 | [diff] [blame] | 779 | /* | 
|  | 780 | * We put a few things here that have to be page-aligned. | 
|  | 781 | * This stuff goes at the beginning of the bss, which is page-aligned. | 
|  | 782 | */ | 
|  | 783 | .section ".bss" | 
|  | 784 |  | 
|  | 785 | .align	PAGE_SHIFT | 
|  | 786 |  | 
|  | 787 | .globl	empty_zero_page | 
|  | 788 | empty_zero_page: | 
|  | 789 | .space	PAGE_SIZE | 
|  | 790 |  | 
|  | 791 | .globl	swapper_pg_dir | 
|  | 792 | swapper_pg_dir: | 
| Stephen Rothwell | ee7a76d | 2007-09-18 17:22:59 +1000 | [diff] [blame] | 793 | .space	PGD_TABLE_SIZE |