1/* SPDX-License-Identifier: GPL-2.0-or-later */ 2/* 3 * PowerPC version 4 * Copyright (C) 1995-1996 Gary Thomas (gdt@linuxppc.org) 5 * 6 * Rewritten by Cort Dougan (cort@cs.nmt.edu) for PReP 7 * Copyright (C) 1996 Cort Dougan <cort@cs.nmt.edu> 8 * Adapted for Power Macintosh by Paul Mackerras. 9 * Low-level exception handlers and MMU support 10 * rewritten by Paul Mackerras. 11 * Copyright (C) 1996 Paul Mackerras. 12 * 13 * Adapted for 64bit PowerPC by Dave Engebretsen, Peter Bergner, and 14 * Mike Corrigan {engebret|bergner|mikejc}@us.ibm.com 15 * 16 * This file contains the entry point for the 64-bit kernel along 17 * with some early initialization code common to all 64-bit powerpc 18 * variants. 19 */ 20 21#include <linux/threads.h> 22#include <linux/init.h> 23#include <asm/reg.h> 24#include <asm/page.h> 25#include <asm/mmu.h> 26#include <asm/ppc_asm.h> 27#include <asm/head-64.h> 28#include <asm/asm-offsets.h> 29#include <asm/bug.h> 30#include <asm/cputable.h> 31#include <asm/setup.h> 32#include <asm/hvcall.h> 33#include <asm/thread_info.h> 34#include <asm/firmware.h> 35#include <asm/page_64.h> 36#include <asm/irqflags.h> 37#include <asm/kvm_book3s_asm.h> 38#include <asm/ptrace.h> 39#include <asm/hw_irq.h> 40#include <asm/cputhreads.h> 41#include <asm/ppc-opcode.h> 42#include <asm/export.h> 43#include <asm/feature-fixups.h> 44#ifdef CONFIG_PPC_BOOK3S 45#include <asm/exception-64s.h> 46#else 47#include <asm/exception-64e.h> 48#endif 49 50/* The physical memory is laid out such that the secondary processor 51 * spin code sits at 0x0000...0x00ff. On server, the vectors follow 52 * using the layout described in exceptions-64s.S 53 */ 54 55/* 56 * Entering into this code we make the following assumptions: 57 * 58 * For pSeries or server processors: 59 * 1. The MMU is off & open firmware is running in real mode. 60 * 2. The primary CPU enters at __start. 61 * 3. If the RTAS supports "query-cpu-stopped-state", then secondary 62 * CPUs will enter as directed by "start-cpu" RTAS call, which is 63 * generic_secondary_smp_init, with PIR in r3. 64 * 4. Else the secondary CPUs will enter at secondary_hold (0x60) as 65 * directed by the "start-cpu" RTS call, with PIR in r3. 66 * -or- For OPAL entry: 67 * 1. The MMU is off, processor in HV mode. 68 * 2. The primary CPU enters at 0 with device-tree in r3, OPAL base 69 * in r8, and entry in r9 for debugging purposes. 70 * 3. Secondary CPUs enter as directed by OPAL_START_CPU call, which 71 * is at generic_secondary_smp_init, with PIR in r3. 72 * 73 * For Book3E processors: 74 * 1. The MMU is on running in AS0 in a state defined in ePAPR 75 * 2. The kernel is entered at __start 76 */ 77 78OPEN_FIXED_SECTION(first_256B, 0x0, 0x100) 79USE_FIXED_SECTION(first_256B) 80 /* 81 * Offsets are relative from the start of fixed section, and 82 * first_256B starts at 0. Offsets are a bit easier to use here 83 * than the fixed section entry macros. 84 */ 85 . = 0x0 86_GLOBAL(__start) 87 /* NOP this out unconditionally */ 88BEGIN_FTR_SECTION 89 FIXUP_ENDIAN 90 b __start_initialization_multiplatform 91END_FTR_SECTION(0, 1) 92 93 /* Catch branch to 0 in real mode */ 94 trap 95 96 /* Secondary processors spin on this value until it becomes non-zero. 97 * When non-zero, it contains the real address of the function the cpu 98 * should jump to. 99 */ 100 .balign 8 101 .globl __secondary_hold_spinloop 102__secondary_hold_spinloop: 103 .8byte 0x0 104 105 /* Secondary processors write this value with their cpu # */ 106 /* after they enter the spin loop immediately below. */ 107 .globl __secondary_hold_acknowledge 108__secondary_hold_acknowledge: 109 .8byte 0x0 110 111#ifdef CONFIG_RELOCATABLE 112 /* This flag is set to 1 by a loader if the kernel should run 113 * at the loaded address instead of the linked address. This 114 * is used by kexec-tools to keep the kdump kernel in the 115 * crash_kernel region. The loader is responsible for 116 * observing the alignment requirement. 117 */ 118 119#ifdef CONFIG_RELOCATABLE_TEST 120#define RUN_AT_LOAD_DEFAULT 1 /* Test relocation, do not copy to 0 */ 121#else 122#define RUN_AT_LOAD_DEFAULT 0x72756e30 /* "run0" -- relocate to 0 by default */ 123#endif 124 125 /* Do not move this variable as kexec-tools knows about it. */ 126 . = 0x5c 127 .globl __run_at_load 128__run_at_load: 129DEFINE_FIXED_SYMBOL(__run_at_load, first_256B) 130 .long RUN_AT_LOAD_DEFAULT 131#endif 132 133 . = 0x60 134/* 135 * The following code is used to hold secondary processors 136 * in a spin loop after they have entered the kernel, but 137 * before the bulk of the kernel has been relocated. This code 138 * is relocated to physical address 0x60 before prom_init is run. 139 * All of it must fit below the first exception vector at 0x100. 140 * Use .globl here not _GLOBAL because we want __secondary_hold 141 * to be the actual text address, not a descriptor. 142 */ 143 .globl __secondary_hold 144__secondary_hold: 145 FIXUP_ENDIAN 146#ifndef CONFIG_PPC_BOOK3E_64 147 mfmsr r24 148 ori r24,r24,MSR_RI 149 mtmsrd r24 /* RI on */ 150#endif 151 /* Grab our physical cpu number */ 152 mr r24,r3 153 /* stash r4 for book3e */ 154 mr r25,r4 155 156 /* Tell the master cpu we're here */ 157 /* Relocation is off & we are located at an address less */ 158 /* than 0x100, so only need to grab low order offset. */ 159 std r24,(ABS_ADDR(__secondary_hold_acknowledge, first_256B))(0) 160 sync 161 162 li r26,0 163#ifdef CONFIG_PPC_BOOK3E_64 164 tovirt(r26,r26) 165#endif 166 /* All secondary cpus wait here until told to start. */ 167100: ld r12,(ABS_ADDR(__secondary_hold_spinloop, first_256B))(r26) 168 cmpdi 0,r12,0 169 beq 100b 170 171#if defined(CONFIG_SMP) || defined(CONFIG_KEXEC_CORE) 172#ifdef CONFIG_PPC_BOOK3E_64 173 tovirt(r12,r12) 174#endif 175 mtctr r12 176 mr r3,r24 177 /* 178 * it may be the case that other platforms have r4 right to 179 * begin with, this gives us some safety in case it is not 180 */ 181#ifdef CONFIG_PPC_BOOK3E_64 182 mr r4,r25 183#else 184 li r4,0 185#endif 186 /* Make sure that patched code is visible */ 187 isync 188 bctr 189#else 1900: trap 191 EMIT_BUG_ENTRY 0b, __FILE__, __LINE__, 0 192#endif 193CLOSE_FIXED_SECTION(first_256B) 194 195/* 196 * On server, we include the exception vectors code here as it 197 * relies on absolute addressing which is only possible within 198 * this compilation unit 199 */ 200#ifdef CONFIG_PPC_BOOK3S 201#include "exceptions-64s.S" 202#else 203OPEN_TEXT_SECTION(0x100) 204#endif 205 206USE_TEXT_SECTION() 207 208#include "interrupt_64.S" 209 210#ifdef CONFIG_PPC_BOOK3E_64 211/* 212 * The booting_thread_hwid holds the thread id we want to boot in cpu 213 * hotplug case. It is set by cpu hotplug code, and is invalid by default. 214 * The thread id is the same as the initial value of SPRN_PIR[THREAD_ID] 215 * bit field. 216 */ 217 .globl booting_thread_hwid 218booting_thread_hwid: 219 .long INVALID_THREAD_HWID 220 .align 3 221/* 222 * start a thread in the same core 223 * input parameters: 224 * r3 = the thread physical id 225 * r4 = the entry point where thread starts 226 */ 227_GLOBAL(book3e_start_thread) 228 LOAD_REG_IMMEDIATE(r5, MSR_KERNEL) 229 cmpwi r3, 0 230 beq 10f 231 cmpwi r3, 1 232 beq 11f 233 /* If the thread id is invalid, just exit. */ 234 b 13f 23510: 236 MTTMR(TMRN_IMSR0, 5) 237 MTTMR(TMRN_INIA0, 4) 238 b 12f 23911: 240 MTTMR(TMRN_IMSR1, 5) 241 MTTMR(TMRN_INIA1, 4) 24212: 243 isync 244 li r6, 1 245 sld r6, r6, r3 246 mtspr SPRN_TENS, r6 24713: 248 blr 249 250/* 251 * stop a thread in the same core 252 * input parameter: 253 * r3 = the thread physical id 254 */ 255_GLOBAL(book3e_stop_thread) 256 cmpwi r3, 0 257 beq 10f 258 cmpwi r3, 1 259 beq 10f 260 /* If the thread id is invalid, just exit. */ 261 b 13f 26210: 263 li r4, 1 264 sld r4, r4, r3 265 mtspr SPRN_TENC, r4 26613: 267 blr 268 269_GLOBAL(fsl_secondary_thread_init) 270 mfspr r4,SPRN_BUCSR 271 272 /* Enable branch prediction */ 273 lis r3,BUCSR_INIT@h 274 ori r3,r3,BUCSR_INIT@l 275 mtspr SPRN_BUCSR,r3 276 isync 277 278 /* 279 * Fix PIR to match the linear numbering in the device tree. 280 * 281 * On e6500, the reset value of PIR uses the low three bits for 282 * the thread within a core, and the upper bits for the core 283 * number. There are two threads per core, so shift everything 284 * but the low bit right by two bits so that the cpu numbering is 285 * continuous. 286 * 287 * If the old value of BUCSR is non-zero, this thread has run 288 * before. Thus, we assume we are coming from kexec or a similar 289 * scenario, and PIR is already set to the correct value. This 290 * is a bit of a hack, but there are limited opportunities for 291 * getting information into the thread and the alternatives 292 * seemed like they'd be overkill. We can't tell just by looking 293 * at the old PIR value which state it's in, since the same value 294 * could be valid for one thread out of reset and for a different 295 * thread in Linux. 296 */ 297 298 mfspr r3, SPRN_PIR 299 cmpwi r4,0 300 bne 1f 301 rlwimi r3, r3, 30, 2, 30 302 mtspr SPRN_PIR, r3 3031: 304 mr r24,r3 305 306 /* turn on 64-bit mode */ 307 bl enable_64b_mode 308 309 /* get a valid TOC pointer, wherever we're mapped at */ 310 bl relative_toc 311 tovirt(r2,r2) 312 313 /* Book3E initialization */ 314 mr r3,r24 315 bl book3e_secondary_thread_init 316 b generic_secondary_common_init 317 318#endif /* CONFIG_PPC_BOOK3E_64 */ 319 320/* 321 * On pSeries and most other platforms, secondary processors spin 322 * in the following code. 323 * At entry, r3 = this processor's number (physical cpu id) 324 * 325 * On Book3E, r4 = 1 to indicate that the initial TLB entry for 326 * this core already exists (setup via some other mechanism such 327 * as SCOM before entry). 328 */ 329_GLOBAL(generic_secondary_smp_init) 330 FIXUP_ENDIAN 331 mr r24,r3 332 mr r25,r4 333 334 /* turn on 64-bit mode */ 335 bl enable_64b_mode 336 337 /* get a valid TOC pointer, wherever we're mapped at */ 338 bl relative_toc 339 tovirt(r2,r2) 340 341#ifdef CONFIG_PPC_BOOK3E_64 342 /* Book3E initialization */ 343 mr r3,r24 344 mr r4,r25 345 bl book3e_secondary_core_init 346 347/* 348 * After common core init has finished, check if the current thread is the 349 * one we wanted to boot. If not, start the specified thread and stop the 350 * current thread. 351 */ 352 LOAD_REG_ADDR(r4, booting_thread_hwid) 353 lwz r3, 0(r4) 354 li r5, INVALID_THREAD_HWID 355 cmpw r3, r5 356 beq 20f 357 358 /* 359 * The value of booting_thread_hwid has been stored in r3, 360 * so make it invalid. 361 */ 362 stw r5, 0(r4) 363 364 /* 365 * Get the current thread id and check if it is the one we wanted. 366 * If not, start the one specified in booting_thread_hwid and stop 367 * the current thread. 368 */ 369 mfspr r8, SPRN_TIR 370 cmpw r3, r8 371 beq 20f 372 373 /* start the specified thread */ 374 LOAD_REG_ADDR(r5, fsl_secondary_thread_init) 375 ld r4, 0(r5) 376 bl book3e_start_thread 377 378 /* stop the current thread */ 379 mr r3, r8 380 bl book3e_stop_thread 38110: 382 b 10b 38320: 384#endif 385 386generic_secondary_common_init: 387 /* Set up a paca value for this processor. Since we have the 388 * physical cpu id in r24, we need to search the pacas to find 389 * which logical id maps to our physical one. 390 */ 391#ifndef CONFIG_SMP 392 b kexec_wait /* wait for next kernel if !SMP */ 393#else 394 LOAD_REG_ADDR(r8, paca_ptrs) /* Load paca_ptrs pointe */ 395 ld r8,0(r8) /* Get base vaddr of array */ 396#if (NR_CPUS == 1) || defined(CONFIG_FORCE_NR_CPUS) 397 LOAD_REG_IMMEDIATE(r7, NR_CPUS) 398#else 399 LOAD_REG_ADDR(r7, nr_cpu_ids) /* Load nr_cpu_ids address */ 400 lwz r7,0(r7) /* also the max paca allocated */ 401#endif 402 li r5,0 /* logical cpu id */ 4031: 404 sldi r9,r5,3 /* get paca_ptrs[] index from cpu id */ 405 ldx r13,r9,r8 /* r13 = paca_ptrs[cpu id] */ 406 lhz r6,PACAHWCPUID(r13) /* Load HW procid from paca */ 407 cmpw r6,r24 /* Compare to our id */ 408 beq 2f 409 addi r5,r5,1 410 cmpw r5,r7 /* Check if more pacas exist */ 411 blt 1b 412 413 mr r3,r24 /* not found, copy phys to r3 */ 414 b kexec_wait /* next kernel might do better */ 415 4162: SET_PACA(r13) 417#ifdef CONFIG_PPC_BOOK3E_64 418 addi r12,r13,PACA_EXTLB /* and TLB exc frame in another */ 419 mtspr SPRN_SPRG_TLB_EXFRAME,r12 420#endif 421 422 /* From now on, r24 is expected to be logical cpuid */ 423 mr r24,r5 424 425 /* Create a temp kernel stack for use before relocation is on. */ 426 ld r1,PACAEMERGSP(r13) 427 subi r1,r1,STACK_FRAME_OVERHEAD 428 429 /* See if we need to call a cpu state restore handler */ 430 LOAD_REG_ADDR(r23, cur_cpu_spec) 431 ld r23,0(r23) 432 ld r12,CPU_SPEC_RESTORE(r23) 433 cmpdi 0,r12,0 434 beq 3f 435#ifdef CONFIG_PPC64_ELF_ABI_V1 436 ld r12,0(r12) 437#endif 438 mtctr r12 439 bctrl 440 4413: LOAD_REG_ADDR(r3, spinning_secondaries) /* Decrement spinning_secondaries */ 442 lwarx r4,0,r3 443 subi r4,r4,1 444 stwcx. r4,0,r3 445 bne 3b 446 isync 447 4484: HMT_LOW 449 lbz r23,PACAPROCSTART(r13) /* Test if this processor should */ 450 /* start. */ 451 cmpwi 0,r23,0 452 beq 4b /* Loop until told to go */ 453 454 sync /* order paca.run and cur_cpu_spec */ 455 isync /* In case code patching happened */ 456 457 b __secondary_start 458#endif /* SMP */ 459 460/* 461 * Turn the MMU off. 462 * Assumes we're mapped EA == RA if the MMU is on. 463 */ 464#ifdef CONFIG_PPC_BOOK3S 465__mmu_off: 466 mfmsr r3 467 andi. r0,r3,MSR_IR|MSR_DR 468 beqlr 469 mflr r4 470 andc r3,r3,r0 471 mtspr SPRN_SRR0,r4 472 mtspr SPRN_SRR1,r3 473 sync 474 rfid 475 b . /* prevent speculative execution */ 476#endif 477 478 479/* 480 * Here is our main kernel entry point. We support currently 2 kind of entries 481 * depending on the value of r5. 482 * 483 * r5 != NULL -> OF entry, we go to prom_init, "legacy" parameter content 484 * in r3...r7 485 * 486 * r5 == NULL -> kexec style entry. r3 is a physical pointer to the 487 * DT block, r4 is a physical pointer to the kernel itself 488 * 489 */ 490__start_initialization_multiplatform: 491 /* Make sure we are running in 64 bits mode */ 492 bl enable_64b_mode 493 494 /* Zero r13 (paca) so early program check / mce don't use it */ 495 li r13,0 496 497 /* Get TOC pointer (current runtime address) */ 498 bl relative_toc 499 500 /* find out where we are now */ 501 bcl 20,31,$+4 5020: mflr r26 /* r26 = runtime addr here */ 503 addis r26,r26,(_stext - 0b)@ha 504 addi r26,r26,(_stext - 0b)@l /* current runtime base addr */ 505 506 /* 507 * Are we booted from a PROM Of-type client-interface ? 508 */ 509 cmpldi cr0,r5,0 510 beq 1f 511 b __boot_from_prom /* yes -> prom */ 5121: 513 /* Save parameters */ 514 mr r31,r3 515 mr r30,r4 516#ifdef CONFIG_PPC_EARLY_DEBUG_OPAL 517 /* Save OPAL entry */ 518 mr r28,r8 519 mr r29,r9 520#endif 521 522#ifdef CONFIG_PPC_BOOK3E_64 523 bl start_initialization_book3e 524 b __after_prom_start 525#else 526 /* Setup some critical 970 SPRs before switching MMU off */ 527 mfspr r0,SPRN_PVR 528 srwi r0,r0,16 529 cmpwi r0,0x39 /* 970 */ 530 beq 1f 531 cmpwi r0,0x3c /* 970FX */ 532 beq 1f 533 cmpwi r0,0x44 /* 970MP */ 534 beq 1f 535 cmpwi r0,0x45 /* 970GX */ 536 bne 2f 5371: bl __cpu_preinit_ppc970 5382: 539 540 /* Switch off MMU if not already off */ 541 bl __mmu_off 542 b __after_prom_start 543#endif /* CONFIG_PPC_BOOK3E_64 */ 544 545__REF 546__boot_from_prom: 547#ifdef CONFIG_PPC_OF_BOOT_TRAMPOLINE 548 /* Save parameters */ 549 mr r31,r3 550 mr r30,r4 551 mr r29,r5 552 mr r28,r6 553 mr r27,r7 554 555 /* 556 * Align the stack to 16-byte boundary 557 * Depending on the size and layout of the ELF sections in the initial 558 * boot binary, the stack pointer may be unaligned on PowerMac 559 */ 560 rldicr r1,r1,0,59 561 562#ifdef CONFIG_RELOCATABLE 563 /* Relocate code for where we are now */ 564 mr r3,r26 565 bl relocate 566#endif 567 568 /* Restore parameters */ 569 mr r3,r31 570 mr r4,r30 571 mr r5,r29 572 mr r6,r28 573 mr r7,r27 574 575 /* Do all of the interaction with OF client interface */ 576 mr r8,r26 577 bl prom_init 578#endif /* #CONFIG_PPC_OF_BOOT_TRAMPOLINE */ 579 580 /* We never return. We also hit that trap if trying to boot 581 * from OF while CONFIG_PPC_OF_BOOT_TRAMPOLINE isn't selected */ 582 trap 583 .previous 584 585__after_prom_start: 586#ifdef CONFIG_RELOCATABLE 587 /* process relocations for the final address of the kernel */ 588 lis r25,PAGE_OFFSET@highest /* compute virtual base of kernel */ 589 sldi r25,r25,32 590#if defined(CONFIG_PPC_BOOK3E_64) 591 tovirt(r26,r26) /* on booke, we already run at PAGE_OFFSET */ 592#endif 593 lwz r7,(FIXED_SYMBOL_ABS_ADDR(__run_at_load))(r26) 594#if defined(CONFIG_PPC_BOOK3E_64) 595 tophys(r26,r26) 596#endif 597 cmplwi cr0,r7,1 /* flagged to stay where we are ? */ 598 bne 1f 599 add r25,r25,r26 6001: mr r3,r25 601 bl relocate 602#if defined(CONFIG_PPC_BOOK3E_64) 603 /* IVPR needs to be set after relocation. */ 604 bl init_core_book3e 605#endif 606#endif 607 608/* 609 * We need to run with _stext at physical address PHYSICAL_START. 610 * This will leave some code in the first 256B of 611 * real memory, which are reserved for software use. 612 * 613 * Note: This process overwrites the OF exception vectors. 614 */ 615 li r3,0 /* target addr */ 616#ifdef CONFIG_PPC_BOOK3E_64 617 tovirt(r3,r3) /* on booke, we already run at PAGE_OFFSET */ 618#endif 619 mr. r4,r26 /* In some cases the loader may */ 620#if defined(CONFIG_PPC_BOOK3E_64) 621 tovirt(r4,r4) 622#endif 623 beq 9f /* have already put us at zero */ 624 li r6,0x100 /* Start offset, the first 0x100 */ 625 /* bytes were copied earlier. */ 626 627#ifdef CONFIG_RELOCATABLE 628/* 629 * Check if the kernel has to be running as relocatable kernel based on the 630 * variable __run_at_load, if it is set the kernel is treated as relocatable 631 * kernel, otherwise it will be moved to PHYSICAL_START 632 */ 633#if defined(CONFIG_PPC_BOOK3E_64) 634 tovirt(r26,r26) /* on booke, we already run at PAGE_OFFSET */ 635#endif 636 lwz r7,(FIXED_SYMBOL_ABS_ADDR(__run_at_load))(r26) 637 cmplwi cr0,r7,1 638 bne 3f 639 640#ifdef CONFIG_PPC_BOOK3E_64 641 LOAD_REG_ADDR(r5, __end_interrupts) 642 LOAD_REG_ADDR(r11, _stext) 643 sub r5,r5,r11 644#else 645 /* just copy interrupts */ 646 LOAD_REG_IMMEDIATE_SYM(r5, r11, FIXED_SYMBOL_ABS_ADDR(__end_interrupts)) 647#endif 648 b 5f 6493: 650#endif 651 /* # bytes of memory to copy */ 652 lis r5,(ABS_ADDR(copy_to_here, text))@ha 653 addi r5,r5,(ABS_ADDR(copy_to_here, text))@l 654 655 bl copy_and_flush /* copy the first n bytes */ 656 /* this includes the code being */ 657 /* executed here. */ 658 /* Jump to the copy of this code that we just made */ 659 addis r8,r3,(ABS_ADDR(4f, text))@ha 660 addi r12,r8,(ABS_ADDR(4f, text))@l 661 mtctr r12 662 bctr 663 664.balign 8 665p_end: .8byte _end - copy_to_here 666 6674: 668 /* 669 * Now copy the rest of the kernel up to _end, add 670 * _end - copy_to_here to the copy limit and run again. 671 */ 672 addis r8,r26,(ABS_ADDR(p_end, text))@ha 673 ld r8,(ABS_ADDR(p_end, text))@l(r8) 674 add r5,r5,r8 6755: bl copy_and_flush /* copy the rest */ 676 6779: b start_here_multiplatform 678 679/* 680 * Copy routine used to copy the kernel to start at physical address 0 681 * and flush and invalidate the caches as needed. 682 * r3 = dest addr, r4 = source addr, r5 = copy limit, r6 = start offset 683 * on exit, r3, r4, r5 are unchanged, r6 is updated to be >= r5. 684 * 685 * Note: this routine *only* clobbers r0, r6 and lr 686 */ 687_GLOBAL(copy_and_flush) 688 addi r5,r5,-8 689 addi r6,r6,-8 6904: li r0,8 /* Use the smallest common */ 691 /* denominator cache line */ 692 /* size. This results in */ 693 /* extra cache line flushes */ 694 /* but operation is correct. */ 695 /* Can't get cache line size */ 696 /* from NACA as it is being */ 697 /* moved too. */ 698 699 mtctr r0 /* put # words/line in ctr */ 7003: addi r6,r6,8 /* copy a cache line */ 701 ldx r0,r6,r4 702 stdx r0,r6,r3 703 bdnz 3b 704 dcbst r6,r3 /* write it to memory */ 705 sync 706 icbi r6,r3 /* flush the icache line */ 707 cmpld 0,r6,r5 708 blt 4b 709 sync 710 addi r5,r5,8 711 addi r6,r6,8 712 isync 713 blr 714 715_ASM_NOKPROBE_SYMBOL(copy_and_flush); /* Called in real mode */ 716 717.align 8 718copy_to_here: 719 720#ifdef CONFIG_SMP 721#ifdef CONFIG_PPC_PMAC 722/* 723 * On PowerMac, secondary processors starts from the reset vector, which 724 * is temporarily turned into a call to one of the functions below. 725 */ 726 .section ".text"; 727 .align 2 ; 728 729 .globl __secondary_start_pmac_0 730__secondary_start_pmac_0: 731 /* NB the entries for cpus 0, 1, 2 must each occupy 8 bytes. */ 732 li r24,0 733 b 1f 734 li r24,1 735 b 1f 736 li r24,2 737 b 1f 738 li r24,3 7391: 740 741_GLOBAL(pmac_secondary_start) 742 /* turn on 64-bit mode */ 743 bl enable_64b_mode 744 745 li r0,0 746 mfspr r3,SPRN_HID4 747 rldimi r3,r0,40,23 /* clear bit 23 (rm_ci) */ 748 sync 749 mtspr SPRN_HID4,r3 750 isync 751 sync 752 slbia 753 754 /* get TOC pointer (real address) */ 755 bl relative_toc 756 tovirt(r2,r2) 757 758 /* Copy some CPU settings from CPU 0 */ 759 bl __restore_cpu_ppc970 760 761 /* pSeries do that early though I don't think we really need it */ 762 mfmsr r3 763 ori r3,r3,MSR_RI 764 mtmsrd r3 /* RI on */ 765 766 /* Set up a paca value for this processor. */ 767 LOAD_REG_ADDR(r4,paca_ptrs) /* Load paca pointer */ 768 ld r4,0(r4) /* Get base vaddr of paca_ptrs array */ 769 sldi r5,r24,3 /* get paca_ptrs[] index from cpu id */ 770 ldx r13,r5,r4 /* r13 = paca_ptrs[cpu id] */ 771 SET_PACA(r13) /* Save vaddr of paca in an SPRG*/ 772 773 /* Mark interrupts soft and hard disabled (they might be enabled 774 * in the PACA when doing hotplug) 775 */ 776 li r0,IRQS_DISABLED 777 stb r0,PACAIRQSOFTMASK(r13) 778 li r0,PACA_IRQ_HARD_DIS 779 stb r0,PACAIRQHAPPENED(r13) 780 781 /* Create a temp kernel stack for use before relocation is on. */ 782 ld r1,PACAEMERGSP(r13) 783 subi r1,r1,STACK_FRAME_OVERHEAD 784 785 b __secondary_start 786 787#endif /* CONFIG_PPC_PMAC */ 788 789/* 790 * This function is called after the master CPU has released the 791 * secondary processors. The execution environment is relocation off. 792 * The paca for this processor has the following fields initialized at 793 * this point: 794 * 1. Processor number 795 * 2. Segment table pointer (virtual address) 796 * On entry the following are set: 797 * r1 = stack pointer (real addr of temp stack) 798 * r24 = cpu# (in Linux terms) 799 * r13 = paca virtual address 800 * SPRG_PACA = paca virtual address 801 */ 802 .section ".text"; 803 .align 2 ; 804 805 .globl __secondary_start 806__secondary_start: 807 /* Set thread priority to MEDIUM */ 808 HMT_MEDIUM 809 810 /* 811 * Do early setup for this CPU, in particular initialising the MMU so we 812 * can turn it on below. This is a call to C, which is OK, we're still 813 * running on the emergency stack. 814 */ 815 bl early_setup_secondary 816 817 /* 818 * The primary has initialized our kernel stack for us in the paca, grab 819 * it and put it in r1. We must *not* use it until we turn on the MMU 820 * below, because it may not be inside the RMO. 821 */ 822 ld r1, PACAKSAVE(r13) 823 824 /* Clear backchain so we get nice backtraces */ 825 li r7,0 826 mtlr r7 827 828 /* Mark interrupts soft and hard disabled (they might be enabled 829 * in the PACA when doing hotplug) 830 */ 831 li r7,IRQS_DISABLED 832 stb r7,PACAIRQSOFTMASK(r13) 833 li r0,PACA_IRQ_HARD_DIS 834 stb r0,PACAIRQHAPPENED(r13) 835 836 /* enable MMU and jump to start_secondary */ 837 LOAD_REG_ADDR(r3, start_secondary_prolog) 838 LOAD_REG_IMMEDIATE(r4, MSR_KERNEL) 839 840 mtspr SPRN_SRR0,r3 841 mtspr SPRN_SRR1,r4 842 RFI_TO_KERNEL 843 b . /* prevent speculative execution */ 844 845/* 846 * Running with relocation on at this point. All we want to do is 847 * zero the stack back-chain pointer and get the TOC virtual address 848 * before going into C code. 849 */ 850start_secondary_prolog: 851 LOAD_PACA_TOC() 852 li r3,0 853 std r3,0(r1) /* Zero the stack frame pointer */ 854 bl start_secondary 855 b . 856/* 857 * Reset stack pointer and call start_secondary 858 * to continue with online operation when woken up 859 * from cede in cpu offline. 860 */ 861_GLOBAL(start_secondary_resume) 862 ld r1,PACAKSAVE(r13) /* Reload kernel stack pointer */ 863 li r3,0 864 std r3,0(r1) /* Zero the stack frame pointer */ 865 bl start_secondary 866 b . 867#endif 868 869/* 870 * This subroutine clobbers r11 and r12 871 */ 872enable_64b_mode: 873 mfmsr r11 /* grab the current MSR */ 874#ifdef CONFIG_PPC_BOOK3E_64 875 oris r11,r11,0x8000 /* CM bit set, we'll set ICM later */ 876 mtmsr r11 877#else /* CONFIG_PPC_BOOK3E_64 */ 878 LOAD_REG_IMMEDIATE(r12, MSR_64BIT) 879 or r11,r11,r12 880 mtmsrd r11 881 isync 882#endif 883 blr 884 885/* 886 * This puts the TOC pointer into r2, offset by 0x8000 (as expected 887 * by the toolchain). It computes the correct value for wherever we 888 * are running at the moment, using position-independent code. 889 * 890 * Note: The compiler constructs pointers using offsets from the 891 * TOC in -mcmodel=medium mode. After we relocate to 0 but before 892 * the MMU is on we need our TOC to be a virtual address otherwise 893 * these pointers will be real addresses which may get stored and 894 * accessed later with the MMU on. We use tovirt() at the call 895 * sites to handle this. 896 */ 897_GLOBAL(relative_toc) 898 mflr r0 899 bcl 20,31,$+4 9000: mflr r11 901 ld r2,(p_toc - 0b)(r11) 902 add r2,r2,r11 903 mtlr r0 904 blr 905 906.balign 8 907p_toc: .8byte .TOC. - 0b 908 909/* 910 * This is where the main kernel code starts. 911 */ 912__REF 913start_here_multiplatform: 914 /* set up the TOC */ 915 bl relative_toc 916 tovirt(r2,r2) 917 918 /* Clear out the BSS. It may have been done in prom_init, 919 * already but that's irrelevant since prom_init will soon 920 * be detached from the kernel completely. Besides, we need 921 * to clear it now for kexec-style entry. 922 */ 923 LOAD_REG_ADDR(r11,__bss_stop) 924 LOAD_REG_ADDR(r8,__bss_start) 925 sub r11,r11,r8 /* bss size */ 926 addi r11,r11,7 /* round up to an even double word */ 927 srdi. r11,r11,3 /* shift right by 3 */ 928 beq 4f 929 addi r8,r8,-8 930 li r0,0 931 mtctr r11 /* zero this many doublewords */ 9323: stdu r0,8(r8) 933 bdnz 3b 9344: 935 936#ifdef CONFIG_PPC_EARLY_DEBUG_OPAL 937 /* Setup OPAL entry */ 938 LOAD_REG_ADDR(r11, opal) 939 std r28,0(r11); 940 std r29,8(r11); 941#endif 942 943#ifndef CONFIG_PPC_BOOK3E_64 944 mfmsr r6 945 ori r6,r6,MSR_RI 946 mtmsrd r6 /* RI on */ 947#endif 948 949#ifdef CONFIG_RELOCATABLE 950 /* Save the physical address we're running at in kernstart_addr */ 951 LOAD_REG_ADDR(r4, kernstart_addr) 952 clrldi r0,r25,2 953 std r0,0(r4) 954#endif 955 956 /* set up a stack pointer */ 957 LOAD_REG_ADDR(r3,init_thread_union) 958 LOAD_REG_IMMEDIATE(r1,THREAD_SIZE) 959 add r1,r3,r1 960 li r0,0 961 stdu r0,-STACK_FRAME_OVERHEAD(r1) 962 963 /* 964 * Do very early kernel initializations, including initial hash table 965 * and SLB setup before we turn on relocation. 966 */ 967 968#ifdef CONFIG_KASAN 969 bl kasan_early_init 970#endif 971 /* Restore parameters passed from prom_init/kexec */ 972 mr r3,r31 973 LOAD_REG_ADDR(r12, DOTSYM(early_setup)) 974 mtctr r12 975 bctrl /* also sets r13 and SPRG_PACA */ 976 977 LOAD_REG_ADDR(r3, start_here_common) 978 ld r4,PACAKMSR(r13) 979 mtspr SPRN_SRR0,r3 980 mtspr SPRN_SRR1,r4 981 RFI_TO_KERNEL 982 b . /* prevent speculative execution */ 983 984 /* This is where all platforms converge execution */ 985 986start_here_common: 987 /* relocation is on at this point */ 988 std r1,PACAKSAVE(r13) 989 990 /* Load the TOC (virtual address) */ 991 LOAD_PACA_TOC() 992 993 /* Mark interrupts soft and hard disabled (they might be enabled 994 * in the PACA when doing hotplug) 995 */ 996 li r0,IRQS_DISABLED 997 stb r0,PACAIRQSOFTMASK(r13) 998 li r0,PACA_IRQ_HARD_DIS 999 stb r0,PACAIRQHAPPENED(r13) 1000 1001 /* Generic kernel entry */ 1002 bl start_kernel 1003 1004 /* Not reached */ 10050: trap 1006 EMIT_BUG_ENTRY 0b, __FILE__, __LINE__, 0 1007 .previous 1008