1/* 2 * This program is free software; you can redistribute it and/or modify 3 * it under the terms of the GNU General Public License, version 2, as 4 * published by the Free Software Foundation. 5 * 6 * This program is distributed in the hope that it will be useful, 7 * but WITHOUT ANY WARRANTY; without even the implied warranty of 8 * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the 9 * GNU General Public License for more details. 10 * 11 * Copyright 2011 Paul Mackerras, IBM Corp. <paulus@au1.ibm.com> 12 * 13 * Derived from book3s_rmhandlers.S and other files, which are: 14 * 15 * Copyright SUSE Linux Products GmbH 2009 16 * 17 * Authors: Alexander Graf <agraf@suse.de> 18 */ 19 20#include <asm/ppc_asm.h> 21#include <asm/kvm_asm.h> 22#include <asm/reg.h> 23#include <asm/mmu.h> 24#include <asm/page.h> 25#include <asm/ptrace.h> 26#include <asm/hvcall.h> 27#include <asm/asm-offsets.h> 28#include <asm/exception-64s.h> 29#include <asm/kvm_book3s_asm.h> 30#include <asm/mmu-hash64.h> 31#include <asm/tm.h> 32 33#define VCPU_GPRS_TM(reg) (((reg) * ULONG_SIZE) + VCPU_GPR_TM) 34 35/* Values in HSTATE_NAPPING(r13) */ 36#define NAPPING_CEDE 1 37#define NAPPING_NOVCPU 2 38 39/* 40 * Call kvmppc_hv_entry in real mode. 41 * Must be called with interrupts hard-disabled. 42 * 43 * Input Registers: 44 * 45 * LR = return address to continue at after eventually re-enabling MMU 46 */ 47_GLOBAL_TOC(kvmppc_hv_entry_trampoline) 48 mflr r0 49 std r0, PPC_LR_STKOFF(r1) 50 stdu r1, -112(r1) 51 mfmsr r10 52 LOAD_REG_ADDR(r5, kvmppc_call_hv_entry) 53 li r0,MSR_RI 54 andc r0,r10,r0 55 li r6,MSR_IR | MSR_DR 56 andc r6,r10,r6 57 mtmsrd r0,1 /* clear RI in MSR */ 58 mtsrr0 r5 59 mtsrr1 r6 60 RFI 61 62kvmppc_call_hv_entry: 63 ld r4, HSTATE_KVM_VCPU(r13) 64 bl kvmppc_hv_entry 65 66 /* Back from guest - restore host state and return to caller */ 67 68BEGIN_FTR_SECTION 69 /* Restore host DABR and DABRX */ 70 ld r5,HSTATE_DABR(r13) 71 li r6,7 72 mtspr SPRN_DABR,r5 73 mtspr SPRN_DABRX,r6 74END_FTR_SECTION_IFCLR(CPU_FTR_ARCH_207S) 75 76 /* Restore SPRG3 */ 77 ld r3,PACA_SPRG_VDSO(r13) 78 mtspr SPRN_SPRG_VDSO_WRITE,r3 79 80 /* Reload the host's PMU registers */ 81 ld r3, PACALPPACAPTR(r13) /* is the host using the PMU? */ 82 lbz r4, LPPACA_PMCINUSE(r3) 83 cmpwi r4, 0 84 beq 23f /* skip if not */ 85BEGIN_FTR_SECTION 86 ld r3, HSTATE_MMCR0(r13) 87 andi. r4, r3, MMCR0_PMAO_SYNC | MMCR0_PMAO 88 cmpwi r4, MMCR0_PMAO 89 beql kvmppc_fix_pmao 90END_FTR_SECTION_IFSET(CPU_FTR_PMAO_BUG) 91 lwz r3, HSTATE_PMC1(r13) 92 lwz r4, HSTATE_PMC2(r13) 93 lwz r5, HSTATE_PMC3(r13) 94 lwz r6, HSTATE_PMC4(r13) 95 lwz r8, HSTATE_PMC5(r13) 96 lwz r9, HSTATE_PMC6(r13) 97 mtspr SPRN_PMC1, r3 98 mtspr SPRN_PMC2, r4 99 mtspr SPRN_PMC3, r5 100 mtspr SPRN_PMC4, r6 101 mtspr SPRN_PMC5, r8 102 mtspr SPRN_PMC6, r9 103 ld r3, HSTATE_MMCR0(r13) 104 ld r4, HSTATE_MMCR1(r13) 105 ld r5, HSTATE_MMCRA(r13) 106 ld r6, HSTATE_SIAR(r13) 107 ld r7, HSTATE_SDAR(r13) 108 mtspr SPRN_MMCR1, r4 109 mtspr SPRN_MMCRA, r5 110 mtspr SPRN_SIAR, r6 111 mtspr SPRN_SDAR, r7 112BEGIN_FTR_SECTION 113 ld r8, HSTATE_MMCR2(r13) 114 ld r9, HSTATE_SIER(r13) 115 mtspr SPRN_MMCR2, r8 116 mtspr SPRN_SIER, r9 117END_FTR_SECTION_IFSET(CPU_FTR_ARCH_207S) 118 mtspr SPRN_MMCR0, r3 119 isync 12023: 121 122 /* 123 * Reload DEC. HDEC interrupts were disabled when 124 * we reloaded the host's LPCR value. 125 */ 126 ld r3, HSTATE_DECEXP(r13) 127 mftb r4 128 subf r4, r4, r3 129 mtspr SPRN_DEC, r4 130 131 /* hwthread_req may have got set by cede or no vcpu, so clear it */ 132 li r0, 0 133 stb r0, HSTATE_HWTHREAD_REQ(r13) 134 135 /* 136 * For external and machine check interrupts, we need 137 * to call the Linux handler to process the interrupt. 138 * We do that by jumping to absolute address 0x500 for 139 * external interrupts, or the machine_check_fwnmi label 140 * for machine checks (since firmware might have patched 141 * the vector area at 0x200). The [h]rfid at the end of the 142 * handler will return to the book3s_hv_interrupts.S code. 143 * For other interrupts we do the rfid to get back 144 * to the book3s_hv_interrupts.S code here. 145 */ 146 ld r8, 112+PPC_LR_STKOFF(r1) 147 addi r1, r1, 112 148 ld r7, HSTATE_HOST_MSR(r13) 149 150 cmpwi cr1, r12, BOOK3S_INTERRUPT_MACHINE_CHECK 151 cmpwi r12, BOOK3S_INTERRUPT_EXTERNAL 152 beq 11f 153 cmpwi cr2, r12, BOOK3S_INTERRUPT_HMI 154 beq cr2, 14f /* HMI check */ 155 156 /* RFI into the highmem handler, or branch to interrupt handler */ 157 mfmsr r6 158 li r0, MSR_RI 159 andc r6, r6, r0 160 mtmsrd r6, 1 /* Clear RI in MSR */ 161 mtsrr0 r8 162 mtsrr1 r7 163 beq cr1, 13f /* machine check */ 164 RFI 165 166 /* On POWER7, we have external interrupts set to use HSRR0/1 */ 16711: mtspr SPRN_HSRR0, r8 168 mtspr SPRN_HSRR1, r7 169 ba 0x500 170 17113: b machine_check_fwnmi 172 17314: mtspr SPRN_HSRR0, r8 174 mtspr SPRN_HSRR1, r7 175 b hmi_exception_after_realmode 176 177kvmppc_primary_no_guest: 178 /* We handle this much like a ceded vcpu */ 179 /* put the HDEC into the DEC, since HDEC interrupts don't wake us */ 180 mfspr r3, SPRN_HDEC 181 mtspr SPRN_DEC, r3 182 /* 183 * Make sure the primary has finished the MMU switch. 184 * We should never get here on a secondary thread, but 185 * check it for robustness' sake. 186 */ 187 ld r5, HSTATE_KVM_VCORE(r13) 18865: lbz r0, VCORE_IN_GUEST(r5) 189 cmpwi r0, 0 190 beq 65b 191 /* Set LPCR. */ 192 ld r8,VCORE_LPCR(r5) 193 mtspr SPRN_LPCR,r8 194 isync 195 /* set our bit in napping_threads */ 196 ld r5, HSTATE_KVM_VCORE(r13) 197 lbz r7, HSTATE_PTID(r13) 198 li r0, 1 199 sld r0, r0, r7 200 addi r6, r5, VCORE_NAPPING_THREADS 2011: lwarx r3, 0, r6 202 or r3, r3, r0 203 stwcx. r3, 0, r6 204 bne 1b 205 /* order napping_threads update vs testing entry_exit_map */ 206 isync 207 li r12, 0 208 lwz r7, VCORE_ENTRY_EXIT(r5) 209 cmpwi r7, 0x100 210 bge kvm_novcpu_exit /* another thread already exiting */ 211 li r3, NAPPING_NOVCPU 212 stb r3, HSTATE_NAPPING(r13) 213 214 li r3, 0 /* Don't wake on privileged (OS) doorbell */ 215 b kvm_do_nap 216 217kvm_novcpu_wakeup: 218 ld r1, HSTATE_HOST_R1(r13) 219 ld r5, HSTATE_KVM_VCORE(r13) 220 li r0, 0 221 stb r0, HSTATE_NAPPING(r13) 222 223 /* check the wake reason */ 224 bl kvmppc_check_wake_reason 225 226 /* see if any other thread is already exiting */ 227 lwz r0, VCORE_ENTRY_EXIT(r5) 228 cmpwi r0, 0x100 229 bge kvm_novcpu_exit 230 231 /* clear our bit in napping_threads */ 232 lbz r7, HSTATE_PTID(r13) 233 li r0, 1 234 sld r0, r0, r7 235 addi r6, r5, VCORE_NAPPING_THREADS 2364: lwarx r7, 0, r6 237 andc r7, r7, r0 238 stwcx. r7, 0, r6 239 bne 4b 240 241 /* See if the wake reason means we need to exit */ 242 cmpdi r3, 0 243 bge kvm_novcpu_exit 244 245 /* See if our timeslice has expired (HDEC is negative) */ 246 mfspr r0, SPRN_HDEC 247 li r12, BOOK3S_INTERRUPT_HV_DECREMENTER 248 cmpwi r0, 0 249 blt kvm_novcpu_exit 250 251 /* Got an IPI but other vcpus aren't yet exiting, must be a latecomer */ 252 ld r4, HSTATE_KVM_VCPU(r13) 253 cmpdi r4, 0 254 beq kvmppc_primary_no_guest 255 256#ifdef CONFIG_KVM_BOOK3S_HV_EXIT_TIMING 257 addi r3, r4, VCPU_TB_RMENTRY 258 bl kvmhv_start_timing 259#endif 260 b kvmppc_got_guest 261 262kvm_novcpu_exit: 263#ifdef CONFIG_KVM_BOOK3S_HV_EXIT_TIMING 264 ld r4, HSTATE_KVM_VCPU(r13) 265 cmpdi r4, 0 266 beq 13f 267 addi r3, r4, VCPU_TB_RMEXIT 268 bl kvmhv_accumulate_time 269#endif 27013: mr r3, r12 271 stw r12, 112-4(r1) 272 bl kvmhv_commence_exit 273 nop 274 lwz r12, 112-4(r1) 275 b kvmhv_switch_to_host 276 277/* 278 * We come in here when wakened from nap mode. 279 * Relocation is off and most register values are lost. 280 * r13 points to the PACA. 281 */ 282 .globl kvm_start_guest 283kvm_start_guest: 284 285 /* Set runlatch bit the minute you wake up from nap */ 286 mfspr r0, SPRN_CTRLF 287 ori r0, r0, 1 288 mtspr SPRN_CTRLT, r0 289 290 ld r2,PACATOC(r13) 291 292 li r0,KVM_HWTHREAD_IN_KVM 293 stb r0,HSTATE_HWTHREAD_STATE(r13) 294 295 /* NV GPR values from power7_idle() will no longer be valid */ 296 li r0,1 297 stb r0,PACA_NAPSTATELOST(r13) 298 299 /* were we napping due to cede? */ 300 lbz r0,HSTATE_NAPPING(r13) 301 cmpwi r0,NAPPING_CEDE 302 beq kvm_end_cede 303 cmpwi r0,NAPPING_NOVCPU 304 beq kvm_novcpu_wakeup 305 306 ld r1,PACAEMERGSP(r13) 307 subi r1,r1,STACK_FRAME_OVERHEAD 308 309 /* 310 * We weren't napping due to cede, so this must be a secondary 311 * thread being woken up to run a guest, or being woken up due 312 * to a stray IPI. (Or due to some machine check or hypervisor 313 * maintenance interrupt while the core is in KVM.) 314 */ 315 316 /* Check the wake reason in SRR1 to see why we got here */ 317 bl kvmppc_check_wake_reason 318 cmpdi r3, 0 319 bge kvm_no_guest 320 321 /* get vcore pointer, NULL if we have nothing to run */ 322 ld r5,HSTATE_KVM_VCORE(r13) 323 cmpdi r5,0 324 /* if we have no vcore to run, go back to sleep */ 325 beq kvm_no_guest 326 327kvm_secondary_got_guest: 328 329 /* Set HSTATE_DSCR(r13) to something sensible */ 330 ld r6, PACA_DSCR_DEFAULT(r13) 331 std r6, HSTATE_DSCR(r13) 332 333 /* On thread 0 of a subcore, set HDEC to max */ 334 lbz r4, HSTATE_PTID(r13) 335 cmpwi r4, 0 336 bne 63f 337 lis r6, 0x7fff 338 ori r6, r6, 0xffff 339 mtspr SPRN_HDEC, r6 340 /* and set per-LPAR registers, if doing dynamic micro-threading */ 341 ld r6, HSTATE_SPLIT_MODE(r13) 342 cmpdi r6, 0 343 beq 63f 344 ld r0, KVM_SPLIT_RPR(r6) 345 mtspr SPRN_RPR, r0 346 ld r0, KVM_SPLIT_PMMAR(r6) 347 mtspr SPRN_PMMAR, r0 348 ld r0, KVM_SPLIT_LDBAR(r6) 349 mtspr SPRN_LDBAR, r0 350 isync 35163: 352 /* Order load of vcpu after load of vcore */ 353 lwsync 354 ld r4, HSTATE_KVM_VCPU(r13) 355 bl kvmppc_hv_entry 356 357 /* Back from the guest, go back to nap */ 358 /* Clear our vcpu and vcore pointers so we don't come back in early */ 359 li r0, 0 360 std r0, HSTATE_KVM_VCPU(r13) 361 /* 362 * Once we clear HSTATE_KVM_VCORE(r13), the code in 363 * kvmppc_run_core() is going to assume that all our vcpu 364 * state is visible in memory. This lwsync makes sure 365 * that that is true. 366 */ 367 lwsync 368 std r0, HSTATE_KVM_VCORE(r13) 369 370/* 371 * At this point we have finished executing in the guest. 372 * We need to wait for hwthread_req to become zero, since 373 * we may not turn on the MMU while hwthread_req is non-zero. 374 * While waiting we also need to check if we get given a vcpu to run. 375 */ 376kvm_no_guest: 377 lbz r3, HSTATE_HWTHREAD_REQ(r13) 378 cmpwi r3, 0 379 bne 53f 380 HMT_MEDIUM 381 li r0, KVM_HWTHREAD_IN_KERNEL 382 stb r0, HSTATE_HWTHREAD_STATE(r13) 383 /* need to recheck hwthread_req after a barrier, to avoid race */ 384 sync 385 lbz r3, HSTATE_HWTHREAD_REQ(r13) 386 cmpwi r3, 0 387 bne 54f 388/* 389 * We jump to power7_wakeup_loss, which will return to the caller 390 * of power7_nap in the powernv cpu offline loop. The value we 391 * put in r3 becomes the return value for power7_nap. 392 */ 393 li r3, LPCR_PECE0 394 mfspr r4, SPRN_LPCR 395 rlwimi r4, r3, 0, LPCR_PECE0 | LPCR_PECE1 396 mtspr SPRN_LPCR, r4 397 li r3, 0 398 b power7_wakeup_loss 399 40053: HMT_LOW 401 ld r5, HSTATE_KVM_VCORE(r13) 402 cmpdi r5, 0 403 bne 60f 404 ld r3, HSTATE_SPLIT_MODE(r13) 405 cmpdi r3, 0 406 beq kvm_no_guest 407 lbz r0, KVM_SPLIT_DO_NAP(r3) 408 cmpwi r0, 0 409 beq kvm_no_guest 410 HMT_MEDIUM 411 b kvm_unsplit_nap 41260: HMT_MEDIUM 413 b kvm_secondary_got_guest 414 41554: li r0, KVM_HWTHREAD_IN_KVM 416 stb r0, HSTATE_HWTHREAD_STATE(r13) 417 b kvm_no_guest 418 419/* 420 * Here the primary thread is trying to return the core to 421 * whole-core mode, so we need to nap. 422 */ 423kvm_unsplit_nap: 424 /* 425 * Ensure that secondary doesn't nap when it has 426 * its vcore pointer set. 427 */ 428 sync /* matches smp_mb() before setting split_info.do_nap */ 429 ld r0, HSTATE_KVM_VCORE(r13) 430 cmpdi r0, 0 431 bne kvm_no_guest 432 /* clear any pending message */ 433BEGIN_FTR_SECTION 434 lis r6, (PPC_DBELL_SERVER << (63-36))@h 435 PPC_MSGCLR(6) 436END_FTR_SECTION_IFSET(CPU_FTR_ARCH_207S) 437 /* Set kvm_split_mode.napped[tid] = 1 */ 438 ld r3, HSTATE_SPLIT_MODE(r13) 439 li r0, 1 440 lhz r4, PACAPACAINDEX(r13) 441 clrldi r4, r4, 61 /* micro-threading => P8 => 8 threads/core */ 442 addi r4, r4, KVM_SPLIT_NAPPED 443 stbx r0, r3, r4 444 /* Check the do_nap flag again after setting napped[] */ 445 sync 446 lbz r0, KVM_SPLIT_DO_NAP(r3) 447 cmpwi r0, 0 448 beq 57f 449 li r3, (LPCR_PECEDH | LPCR_PECE0) >> 4 450 mfspr r4, SPRN_LPCR 451 rlwimi r4, r3, 4, (LPCR_PECEDP | LPCR_PECEDH | LPCR_PECE0 | LPCR_PECE1) 452 mtspr SPRN_LPCR, r4 453 isync 454 std r0, HSTATE_SCRATCH0(r13) 455 ptesync 456 ld r0, HSTATE_SCRATCH0(r13) 4571: cmpd r0, r0 458 bne 1b 459 nap 460 b . 461 46257: li r0, 0 463 stbx r0, r3, r4 464 b kvm_no_guest 465 466/****************************************************************************** 467 * * 468 * Entry code * 469 * * 470 *****************************************************************************/ 471 472.global kvmppc_hv_entry 473kvmppc_hv_entry: 474 475 /* Required state: 476 * 477 * R4 = vcpu pointer (or NULL) 478 * MSR = ~IR|DR 479 * R13 = PACA 480 * R1 = host R1 481 * R2 = TOC 482 * all other volatile GPRS = free 483 */ 484 mflr r0 485 std r0, PPC_LR_STKOFF(r1) 486 stdu r1, -112(r1) 487 488 /* Save R1 in the PACA */ 489 std r1, HSTATE_HOST_R1(r13) 490 491 li r6, KVM_GUEST_MODE_HOST_HV 492 stb r6, HSTATE_IN_GUEST(r13) 493 494#ifdef CONFIG_KVM_BOOK3S_HV_EXIT_TIMING 495 /* Store initial timestamp */ 496 cmpdi r4, 0 497 beq 1f 498 addi r3, r4, VCPU_TB_RMENTRY 499 bl kvmhv_start_timing 5001: 501#endif 502 /* Clear out SLB */ 503 li r6,0 504 slbmte r6,r6 505 slbia 506 ptesync 507 508 /* 509 * POWER7/POWER8 host -> guest partition switch code. 510 * We don't have to lock against concurrent tlbies, 511 * but we do have to coordinate across hardware threads. 512 */ 513 /* Set bit in entry map iff exit map is zero. */ 514 ld r5, HSTATE_KVM_VCORE(r13) 515 li r7, 1 516 lbz r6, HSTATE_PTID(r13) 517 sld r7, r7, r6 518 addi r9, r5, VCORE_ENTRY_EXIT 51921: lwarx r3, 0, r9 520 cmpwi r3, 0x100 /* any threads starting to exit? */ 521 bge secondary_too_late /* if so we're too late to the party */ 522 or r3, r3, r7 523 stwcx. r3, 0, r9 524 bne 21b 525 526 /* Primary thread switches to guest partition. */ 527 ld r9,VCORE_KVM(r5) /* pointer to struct kvm */ 528 cmpwi r6,0 529 bne 10f 530 ld r6,KVM_SDR1(r9) 531 lwz r7,KVM_LPID(r9) 532 li r0,LPID_RSVD /* switch to reserved LPID */ 533 mtspr SPRN_LPID,r0 534 ptesync 535 mtspr SPRN_SDR1,r6 /* switch to partition page table */ 536 mtspr SPRN_LPID,r7 537 isync 538 539 /* See if we need to flush the TLB */ 540 lhz r6,PACAPACAINDEX(r13) /* test_bit(cpu, need_tlb_flush) */ 541 clrldi r7,r6,64-6 /* extract bit number (6 bits) */ 542 srdi r6,r6,6 /* doubleword number */ 543 sldi r6,r6,3 /* address offset */ 544 add r6,r6,r9 545 addi r6,r6,KVM_NEED_FLUSH /* dword in kvm->arch.need_tlb_flush */ 546 li r0,1 547 sld r0,r0,r7 548 ld r7,0(r6) 549 and. r7,r7,r0 550 beq 22f 55123: ldarx r7,0,r6 /* if set, clear the bit */ 552 andc r7,r7,r0 553 stdcx. r7,0,r6 554 bne 23b 555 /* Flush the TLB of any entries for this LPID */ 556 /* use arch 2.07S as a proxy for POWER8 */ 557BEGIN_FTR_SECTION 558 li r6,512 /* POWER8 has 512 sets */ 559FTR_SECTION_ELSE 560 li r6,128 /* POWER7 has 128 sets */ 561ALT_FTR_SECTION_END_IFSET(CPU_FTR_ARCH_207S) 562 mtctr r6 563 li r7,0x800 /* IS field = 0b10 */ 564 ptesync 56528: tlbiel r7 566 addi r7,r7,0x1000 567 bdnz 28b 568 ptesync 569 570 /* Add timebase offset onto timebase */ 57122: ld r8,VCORE_TB_OFFSET(r5) 572 cmpdi r8,0 573 beq 37f 574 mftb r6 /* current host timebase */ 575 add r8,r8,r6 576 mtspr SPRN_TBU40,r8 /* update upper 40 bits */ 577 mftb r7 /* check if lower 24 bits overflowed */ 578 clrldi r6,r6,40 579 clrldi r7,r7,40 580 cmpld r7,r6 581 bge 37f 582 addis r8,r8,0x100 /* if so, increment upper 40 bits */ 583 mtspr SPRN_TBU40,r8 584 585 /* Load guest PCR value to select appropriate compat mode */ 58637: ld r7, VCORE_PCR(r5) 587 cmpdi r7, 0 588 beq 38f 589 mtspr SPRN_PCR, r7 59038: 591 592BEGIN_FTR_SECTION 593 /* DPDES is shared between threads */ 594 ld r8, VCORE_DPDES(r5) 595 mtspr SPRN_DPDES, r8 596END_FTR_SECTION_IFSET(CPU_FTR_ARCH_207S) 597 598 li r0,1 599 stb r0,VCORE_IN_GUEST(r5) /* signal secondaries to continue */ 600 601 /* Do we have a guest vcpu to run? */ 60210: cmpdi r4, 0 603 beq kvmppc_primary_no_guest 604kvmppc_got_guest: 605 606 /* Load up guest SLB entries */ 607 lwz r5,VCPU_SLB_MAX(r4) 608 cmpwi r5,0 609 beq 9f 610 mtctr r5 611 addi r6,r4,VCPU_SLB 6121: ld r8,VCPU_SLB_E(r6) 613 ld r9,VCPU_SLB_V(r6) 614 slbmte r9,r8 615 addi r6,r6,VCPU_SLB_SIZE 616 bdnz 1b 6179: 618 /* Increment yield count if they have a VPA */ 619 ld r3, VCPU_VPA(r4) 620 cmpdi r3, 0 621 beq 25f 622 li r6, LPPACA_YIELDCOUNT 623 LWZX_BE r5, r3, r6 624 addi r5, r5, 1 625 STWX_BE r5, r3, r6 626 li r6, 1 627 stb r6, VCPU_VPA_DIRTY(r4) 62825: 629 630 /* Save purr/spurr */ 631 mfspr r5,SPRN_PURR 632 mfspr r6,SPRN_SPURR 633 std r5,HSTATE_PURR(r13) 634 std r6,HSTATE_SPURR(r13) 635 ld r7,VCPU_PURR(r4) 636 ld r8,VCPU_SPURR(r4) 637 mtspr SPRN_PURR,r7 638 mtspr SPRN_SPURR,r8 639 640BEGIN_FTR_SECTION 641 /* Set partition DABR */ 642 /* Do this before re-enabling PMU to avoid P7 DABR corruption bug */ 643 lwz r5,VCPU_DABRX(r4) 644 ld r6,VCPU_DABR(r4) 645 mtspr SPRN_DABRX,r5 646 mtspr SPRN_DABR,r6 647 isync 648END_FTR_SECTION_IFCLR(CPU_FTR_ARCH_207S) 649 650#ifdef CONFIG_PPC_TRANSACTIONAL_MEM 651BEGIN_FTR_SECTION 652 b skip_tm 653END_FTR_SECTION_IFCLR(CPU_FTR_TM) 654 655 /* Turn on TM/FP/VSX/VMX so we can restore them. */ 656 mfmsr r5 657 li r6, MSR_TM >> 32 658 sldi r6, r6, 32 659 or r5, r5, r6 660 ori r5, r5, MSR_FP 661 oris r5, r5, (MSR_VEC | MSR_VSX)@h 662 mtmsrd r5 663 664 /* 665 * The user may change these outside of a transaction, so they must 666 * always be context switched. 667 */ 668 ld r5, VCPU_TFHAR(r4) 669 ld r6, VCPU_TFIAR(r4) 670 ld r7, VCPU_TEXASR(r4) 671 mtspr SPRN_TFHAR, r5 672 mtspr SPRN_TFIAR, r6 673 mtspr SPRN_TEXASR, r7 674 675 ld r5, VCPU_MSR(r4) 676 rldicl. r5, r5, 64 - MSR_TS_S_LG, 62 677 beq skip_tm /* TM not active in guest */ 678 679 /* Make sure the failure summary is set, otherwise we'll program check 680 * when we trechkpt. It's possible that this might have been not set 681 * on a kvmppc_set_one_reg() call but we shouldn't let this crash the 682 * host. 683 */ 684 oris r7, r7, (TEXASR_FS)@h 685 mtspr SPRN_TEXASR, r7 686 687 /* 688 * We need to load up the checkpointed state for the guest. 689 * We need to do this early as it will blow away any GPRs, VSRs and 690 * some SPRs. 691 */ 692 693 mr r31, r4 694 addi r3, r31, VCPU_FPRS_TM 695 bl load_fp_state 696 addi r3, r31, VCPU_VRS_TM 697 bl load_vr_state 698 mr r4, r31 699 lwz r7, VCPU_VRSAVE_TM(r4) 700 mtspr SPRN_VRSAVE, r7 701 702 ld r5, VCPU_LR_TM(r4) 703 lwz r6, VCPU_CR_TM(r4) 704 ld r7, VCPU_CTR_TM(r4) 705 ld r8, VCPU_AMR_TM(r4) 706 ld r9, VCPU_TAR_TM(r4) 707 mtlr r5 708 mtcr r6 709 mtctr r7 710 mtspr SPRN_AMR, r8 711 mtspr SPRN_TAR, r9 712 713 /* 714 * Load up PPR and DSCR values but don't put them in the actual SPRs 715 * till the last moment to avoid running with userspace PPR and DSCR for 716 * too long. 717 */ 718 ld r29, VCPU_DSCR_TM(r4) 719 ld r30, VCPU_PPR_TM(r4) 720 721 std r2, PACATMSCRATCH(r13) /* Save TOC */ 722 723 /* Clear the MSR RI since r1, r13 are all going to be foobar. */ 724 li r5, 0 725 mtmsrd r5, 1 726 727 /* Load GPRs r0-r28 */ 728 reg = 0 729 .rept 29 730 ld reg, VCPU_GPRS_TM(reg)(r31) 731 reg = reg + 1 732 .endr 733 734 mtspr SPRN_DSCR, r29 735 mtspr SPRN_PPR, r30 736 737 /* Load final GPRs */ 738 ld 29, VCPU_GPRS_TM(29)(r31) 739 ld 30, VCPU_GPRS_TM(30)(r31) 740 ld 31, VCPU_GPRS_TM(31)(r31) 741 742 /* TM checkpointed state is now setup. All GPRs are now volatile. */ 743 TRECHKPT 744 745 /* Now let's get back the state we need. */ 746 HMT_MEDIUM 747 GET_PACA(r13) 748 ld r29, HSTATE_DSCR(r13) 749 mtspr SPRN_DSCR, r29 750 ld r4, HSTATE_KVM_VCPU(r13) 751 ld r1, HSTATE_HOST_R1(r13) 752 ld r2, PACATMSCRATCH(r13) 753 754 /* Set the MSR RI since we have our registers back. */ 755 li r5, MSR_RI 756 mtmsrd r5, 1 757skip_tm: 758#endif 759 760 /* Load guest PMU registers */ 761 /* R4 is live here (vcpu pointer) */ 762 li r3, 1 763 sldi r3, r3, 31 /* MMCR0_FC (freeze counters) bit */ 764 mtspr SPRN_MMCR0, r3 /* freeze all counters, disable ints */ 765 isync 766BEGIN_FTR_SECTION 767 ld r3, VCPU_MMCR(r4) 768 andi. r5, r3, MMCR0_PMAO_SYNC | MMCR0_PMAO 769 cmpwi r5, MMCR0_PMAO 770 beql kvmppc_fix_pmao 771END_FTR_SECTION_IFSET(CPU_FTR_PMAO_BUG) 772 lwz r3, VCPU_PMC(r4) /* always load up guest PMU registers */ 773 lwz r5, VCPU_PMC + 4(r4) /* to prevent information leak */ 774 lwz r6, VCPU_PMC + 8(r4) 775 lwz r7, VCPU_PMC + 12(r4) 776 lwz r8, VCPU_PMC + 16(r4) 777 lwz r9, VCPU_PMC + 20(r4) 778 mtspr SPRN_PMC1, r3 779 mtspr SPRN_PMC2, r5 780 mtspr SPRN_PMC3, r6 781 mtspr SPRN_PMC4, r7 782 mtspr SPRN_PMC5, r8 783 mtspr SPRN_PMC6, r9 784 ld r3, VCPU_MMCR(r4) 785 ld r5, VCPU_MMCR + 8(r4) 786 ld r6, VCPU_MMCR + 16(r4) 787 ld r7, VCPU_SIAR(r4) 788 ld r8, VCPU_SDAR(r4) 789 mtspr SPRN_MMCR1, r5 790 mtspr SPRN_MMCRA, r6 791 mtspr SPRN_SIAR, r7 792 mtspr SPRN_SDAR, r8 793BEGIN_FTR_SECTION 794 ld r5, VCPU_MMCR + 24(r4) 795 ld r6, VCPU_SIER(r4) 796 lwz r7, VCPU_PMC + 24(r4) 797 lwz r8, VCPU_PMC + 28(r4) 798 ld r9, VCPU_MMCR + 32(r4) 799 mtspr SPRN_MMCR2, r5 800 mtspr SPRN_SIER, r6 801 mtspr SPRN_SPMC1, r7 802 mtspr SPRN_SPMC2, r8 803 mtspr SPRN_MMCRS, r9 804END_FTR_SECTION_IFSET(CPU_FTR_ARCH_207S) 805 mtspr SPRN_MMCR0, r3 806 isync 807 808 /* Load up FP, VMX and VSX registers */ 809 bl kvmppc_load_fp 810 811 ld r14, VCPU_GPR(R14)(r4) 812 ld r15, VCPU_GPR(R15)(r4) 813 ld r16, VCPU_GPR(R16)(r4) 814 ld r17, VCPU_GPR(R17)(r4) 815 ld r18, VCPU_GPR(R18)(r4) 816 ld r19, VCPU_GPR(R19)(r4) 817 ld r20, VCPU_GPR(R20)(r4) 818 ld r21, VCPU_GPR(R21)(r4) 819 ld r22, VCPU_GPR(R22)(r4) 820 ld r23, VCPU_GPR(R23)(r4) 821 ld r24, VCPU_GPR(R24)(r4) 822 ld r25, VCPU_GPR(R25)(r4) 823 ld r26, VCPU_GPR(R26)(r4) 824 ld r27, VCPU_GPR(R27)(r4) 825 ld r28, VCPU_GPR(R28)(r4) 826 ld r29, VCPU_GPR(R29)(r4) 827 ld r30, VCPU_GPR(R30)(r4) 828 ld r31, VCPU_GPR(R31)(r4) 829 830 /* Switch DSCR to guest value */ 831 ld r5, VCPU_DSCR(r4) 832 mtspr SPRN_DSCR, r5 833 834BEGIN_FTR_SECTION 835 /* Skip next section on POWER7 */ 836 b 8f 837END_FTR_SECTION_IFCLR(CPU_FTR_ARCH_207S) 838 /* Turn on TM so we can access TFHAR/TFIAR/TEXASR */ 839 mfmsr r8 840 li r0, 1 841 rldimi r8, r0, MSR_TM_LG, 63-MSR_TM_LG 842 mtmsrd r8 843 844 /* Load up POWER8-specific registers */ 845 ld r5, VCPU_IAMR(r4) 846 lwz r6, VCPU_PSPB(r4) 847 ld r7, VCPU_FSCR(r4) 848 mtspr SPRN_IAMR, r5 849 mtspr SPRN_PSPB, r6 850 mtspr SPRN_FSCR, r7 851 ld r5, VCPU_DAWR(r4) 852 ld r6, VCPU_DAWRX(r4) 853 ld r7, VCPU_CIABR(r4) 854 ld r8, VCPU_TAR(r4) 855 mtspr SPRN_DAWR, r5 856 mtspr SPRN_DAWRX, r6 857 mtspr SPRN_CIABR, r7 858 mtspr SPRN_TAR, r8 859 ld r5, VCPU_IC(r4) 860 ld r6, VCPU_VTB(r4) 861 mtspr SPRN_IC, r5 862 mtspr SPRN_VTB, r6 863 ld r8, VCPU_EBBHR(r4) 864 mtspr SPRN_EBBHR, r8 865 ld r5, VCPU_EBBRR(r4) 866 ld r6, VCPU_BESCR(r4) 867 ld r7, VCPU_CSIGR(r4) 868 ld r8, VCPU_TACR(r4) 869 mtspr SPRN_EBBRR, r5 870 mtspr SPRN_BESCR, r6 871 mtspr SPRN_CSIGR, r7 872 mtspr SPRN_TACR, r8 873 ld r5, VCPU_TCSCR(r4) 874 ld r6, VCPU_ACOP(r4) 875 lwz r7, VCPU_GUEST_PID(r4) 876 ld r8, VCPU_WORT(r4) 877 mtspr SPRN_TCSCR, r5 878 mtspr SPRN_ACOP, r6 879 mtspr SPRN_PID, r7 880 mtspr SPRN_WORT, r8 8818: 882 883 /* 884 * Set the decrementer to the guest decrementer. 885 */ 886 ld r8,VCPU_DEC_EXPIRES(r4) 887 /* r8 is a host timebase value here, convert to guest TB */ 888 ld r5,HSTATE_KVM_VCORE(r13) 889 ld r6,VCORE_TB_OFFSET(r5) 890 add r8,r8,r6 891 mftb r7 892 subf r3,r7,r8 893 mtspr SPRN_DEC,r3 894 stw r3,VCPU_DEC(r4) 895 896 ld r5, VCPU_SPRG0(r4) 897 ld r6, VCPU_SPRG1(r4) 898 ld r7, VCPU_SPRG2(r4) 899 ld r8, VCPU_SPRG3(r4) 900 mtspr SPRN_SPRG0, r5 901 mtspr SPRN_SPRG1, r6 902 mtspr SPRN_SPRG2, r7 903 mtspr SPRN_SPRG3, r8 904 905 /* Load up DAR and DSISR */ 906 ld r5, VCPU_DAR(r4) 907 lwz r6, VCPU_DSISR(r4) 908 mtspr SPRN_DAR, r5 909 mtspr SPRN_DSISR, r6 910 911 /* Restore AMR and UAMOR, set AMOR to all 1s */ 912 ld r5,VCPU_AMR(r4) 913 ld r6,VCPU_UAMOR(r4) 914 li r7,-1 915 mtspr SPRN_AMR,r5 916 mtspr SPRN_UAMOR,r6 917 mtspr SPRN_AMOR,r7 918 919 /* Restore state of CTRL run bit; assume 1 on entry */ 920 lwz r5,VCPU_CTRL(r4) 921 andi. r5,r5,1 922 bne 4f 923 mfspr r6,SPRN_CTRLF 924 clrrdi r6,r6,1 925 mtspr SPRN_CTRLT,r6 9264: 927 /* Secondary threads wait for primary to have done partition switch */ 928 ld r5, HSTATE_KVM_VCORE(r13) 929 lbz r6, HSTATE_PTID(r13) 930 cmpwi r6, 0 931 beq 21f 932 lbz r0, VCORE_IN_GUEST(r5) 933 cmpwi r0, 0 934 bne 21f 935 HMT_LOW 93620: lwz r3, VCORE_ENTRY_EXIT(r5) 937 cmpwi r3, 0x100 938 bge no_switch_exit 939 lbz r0, VCORE_IN_GUEST(r5) 940 cmpwi r0, 0 941 beq 20b 942 HMT_MEDIUM 94321: 944 /* Set LPCR. */ 945 ld r8,VCORE_LPCR(r5) 946 mtspr SPRN_LPCR,r8 947 isync 948 949 /* Check if HDEC expires soon */ 950 mfspr r3, SPRN_HDEC 951 cmpwi r3, 512 /* 1 microsecond */ 952 blt hdec_soon 953 954 ld r6, VCPU_CTR(r4) 955 ld r7, VCPU_XER(r4) 956 957 mtctr r6 958 mtxer r7 959 960kvmppc_cede_reentry: /* r4 = vcpu, r13 = paca */ 961 ld r10, VCPU_PC(r4) 962 ld r11, VCPU_MSR(r4) 963 ld r6, VCPU_SRR0(r4) 964 ld r7, VCPU_SRR1(r4) 965 mtspr SPRN_SRR0, r6 966 mtspr SPRN_SRR1, r7 967 968deliver_guest_interrupt: 969 /* r11 = vcpu->arch.msr & ~MSR_HV */ 970 rldicl r11, r11, 63 - MSR_HV_LG, 1 971 rotldi r11, r11, 1 + MSR_HV_LG 972 ori r11, r11, MSR_ME 973 974 /* Check if we can deliver an external or decrementer interrupt now */ 975 ld r0, VCPU_PENDING_EXC(r4) 976 rldicl r0, r0, 64 - BOOK3S_IRQPRIO_EXTERNAL_LEVEL, 63 977 cmpdi cr1, r0, 0 978 andi. r8, r11, MSR_EE 979 mfspr r8, SPRN_LPCR 980 /* Insert EXTERNAL_LEVEL bit into LPCR at the MER bit position */ 981 rldimi r8, r0, LPCR_MER_SH, 63 - LPCR_MER_SH 982 mtspr SPRN_LPCR, r8 983 isync 984 beq 5f 985 li r0, BOOK3S_INTERRUPT_EXTERNAL 986 bne cr1, 12f 987 mfspr r0, SPRN_DEC 988 cmpwi r0, 0 989 li r0, BOOK3S_INTERRUPT_DECREMENTER 990 bge 5f 991 99212: mtspr SPRN_SRR0, r10 993 mr r10,r0 994 mtspr SPRN_SRR1, r11 995 mr r9, r4 996 bl kvmppc_msr_interrupt 9975: 998 999/* 1000 * Required state: 1001 * R4 = vcpu 1002 * R10: value for HSRR0 1003 * R11: value for HSRR1 1004 * R13 = PACA 1005 */ 1006fast_guest_return: 1007 li r0,0 1008 stb r0,VCPU_CEDED(r4) /* cancel cede */ 1009 mtspr SPRN_HSRR0,r10 1010 mtspr SPRN_HSRR1,r11 1011 1012 /* Activate guest mode, so faults get handled by KVM */ 1013 li r9, KVM_GUEST_MODE_GUEST_HV 1014 stb r9, HSTATE_IN_GUEST(r13) 1015 1016#ifdef CONFIG_KVM_BOOK3S_HV_EXIT_TIMING 1017 /* Accumulate timing */ 1018 addi r3, r4, VCPU_TB_GUEST 1019 bl kvmhv_accumulate_time 1020#endif 1021 1022 /* Enter guest */ 1023 1024BEGIN_FTR_SECTION 1025 ld r5, VCPU_CFAR(r4) 1026 mtspr SPRN_CFAR, r5 1027END_FTR_SECTION_IFSET(CPU_FTR_CFAR) 1028BEGIN_FTR_SECTION 1029 ld r0, VCPU_PPR(r4) 1030END_FTR_SECTION_IFSET(CPU_FTR_HAS_PPR) 1031 1032 ld r5, VCPU_LR(r4) 1033 lwz r6, VCPU_CR(r4) 1034 mtlr r5 1035 mtcr r6 1036 1037 ld r1, VCPU_GPR(R1)(r4) 1038 ld r2, VCPU_GPR(R2)(r4) 1039 ld r3, VCPU_GPR(R3)(r4) 1040 ld r5, VCPU_GPR(R5)(r4) 1041 ld r6, VCPU_GPR(R6)(r4) 1042 ld r7, VCPU_GPR(R7)(r4) 1043 ld r8, VCPU_GPR(R8)(r4) 1044 ld r9, VCPU_GPR(R9)(r4) 1045 ld r10, VCPU_GPR(R10)(r4) 1046 ld r11, VCPU_GPR(R11)(r4) 1047 ld r12, VCPU_GPR(R12)(r4) 1048 ld r13, VCPU_GPR(R13)(r4) 1049 1050BEGIN_FTR_SECTION 1051 mtspr SPRN_PPR, r0 1052END_FTR_SECTION_IFSET(CPU_FTR_HAS_PPR) 1053 ld r0, VCPU_GPR(R0)(r4) 1054 ld r4, VCPU_GPR(R4)(r4) 1055 1056 hrfid 1057 b . 1058 1059secondary_too_late: 1060 li r12, 0 1061 cmpdi r4, 0 1062 beq 11f 1063 stw r12, VCPU_TRAP(r4) 1064#ifdef CONFIG_KVM_BOOK3S_HV_EXIT_TIMING 1065 addi r3, r4, VCPU_TB_RMEXIT 1066 bl kvmhv_accumulate_time 1067#endif 106811: b kvmhv_switch_to_host 1069 1070no_switch_exit: 1071 HMT_MEDIUM 1072 li r12, 0 1073 b 12f 1074hdec_soon: 1075 li r12, BOOK3S_INTERRUPT_HV_DECREMENTER 107612: stw r12, VCPU_TRAP(r4) 1077 mr r9, r4 1078#ifdef CONFIG_KVM_BOOK3S_HV_EXIT_TIMING 1079 addi r3, r4, VCPU_TB_RMEXIT 1080 bl kvmhv_accumulate_time 1081#endif 1082 b guest_exit_cont 1083 1084/****************************************************************************** 1085 * * 1086 * Exit code * 1087 * * 1088 *****************************************************************************/ 1089 1090/* 1091 * We come here from the first-level interrupt handlers. 1092 */ 1093 .globl kvmppc_interrupt_hv 1094kvmppc_interrupt_hv: 1095 /* 1096 * Register contents: 1097 * R12 = interrupt vector 1098 * R13 = PACA 1099 * guest CR, R12 saved in shadow VCPU SCRATCH1/0 1100 * guest R13 saved in SPRN_SCRATCH0 1101 */ 1102 std r9, HSTATE_SCRATCH2(r13) 1103 1104 lbz r9, HSTATE_IN_GUEST(r13) 1105 cmpwi r9, KVM_GUEST_MODE_HOST_HV 1106 beq kvmppc_bad_host_intr 1107#ifdef CONFIG_KVM_BOOK3S_PR_POSSIBLE 1108 cmpwi r9, KVM_GUEST_MODE_GUEST 1109 ld r9, HSTATE_SCRATCH2(r13) 1110 beq kvmppc_interrupt_pr 1111#endif 1112 /* We're now back in the host but in guest MMU context */ 1113 li r9, KVM_GUEST_MODE_HOST_HV 1114 stb r9, HSTATE_IN_GUEST(r13) 1115 1116 ld r9, HSTATE_KVM_VCPU(r13) 1117 1118 /* Save registers */ 1119 1120 std r0, VCPU_GPR(R0)(r9) 1121 std r1, VCPU_GPR(R1)(r9) 1122 std r2, VCPU_GPR(R2)(r9) 1123 std r3, VCPU_GPR(R3)(r9) 1124 std r4, VCPU_GPR(R4)(r9) 1125 std r5, VCPU_GPR(R5)(r9) 1126 std r6, VCPU_GPR(R6)(r9) 1127 std r7, VCPU_GPR(R7)(r9) 1128 std r8, VCPU_GPR(R8)(r9) 1129 ld r0, HSTATE_SCRATCH2(r13) 1130 std r0, VCPU_GPR(R9)(r9) 1131 std r10, VCPU_GPR(R10)(r9) 1132 std r11, VCPU_GPR(R11)(r9) 1133 ld r3, HSTATE_SCRATCH0(r13) 1134 lwz r4, HSTATE_SCRATCH1(r13) 1135 std r3, VCPU_GPR(R12)(r9) 1136 stw r4, VCPU_CR(r9) 1137BEGIN_FTR_SECTION 1138 ld r3, HSTATE_CFAR(r13) 1139 std r3, VCPU_CFAR(r9) 1140END_FTR_SECTION_IFSET(CPU_FTR_CFAR) 1141BEGIN_FTR_SECTION 1142 ld r4, HSTATE_PPR(r13) 1143 std r4, VCPU_PPR(r9) 1144END_FTR_SECTION_IFSET(CPU_FTR_HAS_PPR) 1145 1146 /* Restore R1/R2 so we can handle faults */ 1147 ld r1, HSTATE_HOST_R1(r13) 1148 ld r2, PACATOC(r13) 1149 1150 mfspr r10, SPRN_SRR0 1151 mfspr r11, SPRN_SRR1 1152 std r10, VCPU_SRR0(r9) 1153 std r11, VCPU_SRR1(r9) 1154 andi. r0, r12, 2 /* need to read HSRR0/1? */ 1155 beq 1f 1156 mfspr r10, SPRN_HSRR0 1157 mfspr r11, SPRN_HSRR1 1158 clrrdi r12, r12, 2 11591: std r10, VCPU_PC(r9) 1160 std r11, VCPU_MSR(r9) 1161 1162 GET_SCRATCH0(r3) 1163 mflr r4 1164 std r3, VCPU_GPR(R13)(r9) 1165 std r4, VCPU_LR(r9) 1166 1167 stw r12,VCPU_TRAP(r9) 1168 1169#ifdef CONFIG_KVM_BOOK3S_HV_EXIT_TIMING 1170 addi r3, r9, VCPU_TB_RMINTR 1171 mr r4, r9 1172 bl kvmhv_accumulate_time 1173 ld r5, VCPU_GPR(R5)(r9) 1174 ld r6, VCPU_GPR(R6)(r9) 1175 ld r7, VCPU_GPR(R7)(r9) 1176 ld r8, VCPU_GPR(R8)(r9) 1177#endif 1178 1179 /* Save HEIR (HV emulation assist reg) in emul_inst 1180 if this is an HEI (HV emulation interrupt, e40) */ 1181 li r3,KVM_INST_FETCH_FAILED 1182 stw r3,VCPU_LAST_INST(r9) 1183 cmpwi r12,BOOK3S_INTERRUPT_H_EMUL_ASSIST 1184 bne 11f 1185 mfspr r3,SPRN_HEIR 118611: stw r3,VCPU_HEIR(r9) 1187 1188 /* these are volatile across C function calls */ 1189 mfctr r3 1190 mfxer r4 1191 std r3, VCPU_CTR(r9) 1192 std r4, VCPU_XER(r9) 1193 1194 /* If this is a page table miss then see if it's theirs or ours */ 1195 cmpwi r12, BOOK3S_INTERRUPT_H_DATA_STORAGE 1196 beq kvmppc_hdsi 1197 cmpwi r12, BOOK3S_INTERRUPT_H_INST_STORAGE 1198 beq kvmppc_hisi 1199 1200 /* See if this is a leftover HDEC interrupt */ 1201 cmpwi r12,BOOK3S_INTERRUPT_HV_DECREMENTER 1202 bne 2f 1203 mfspr r3,SPRN_HDEC 1204 cmpwi r3,0 1205 mr r4,r9 1206 bge fast_guest_return 12072: 1208 /* See if this is an hcall we can handle in real mode */ 1209 cmpwi r12,BOOK3S_INTERRUPT_SYSCALL 1210 beq hcall_try_real_mode 1211 1212 /* Hypervisor doorbell - exit only if host IPI flag set */ 1213 cmpwi r12, BOOK3S_INTERRUPT_H_DOORBELL 1214 bne 3f 1215 lbz r0, HSTATE_HOST_IPI(r13) 1216 cmpwi r0, 0 1217 beq 4f 1218 b guest_exit_cont 12193: 1220 /* External interrupt ? */ 1221 cmpwi r12, BOOK3S_INTERRUPT_EXTERNAL 1222 bne+ guest_exit_cont 1223 1224 /* External interrupt, first check for host_ipi. If this is 1225 * set, we know the host wants us out so let's do it now 1226 */ 1227 bl kvmppc_read_intr 1228 cmpdi r3, 0 1229 bgt guest_exit_cont 1230 1231 /* Check if any CPU is heading out to the host, if so head out too */ 12324: ld r5, HSTATE_KVM_VCORE(r13) 1233 lwz r0, VCORE_ENTRY_EXIT(r5) 1234 cmpwi r0, 0x100 1235 mr r4, r9 1236 blt deliver_guest_interrupt 1237 1238guest_exit_cont: /* r9 = vcpu, r12 = trap, r13 = paca */ 1239 /* Save more register state */ 1240 mfdar r6 1241 mfdsisr r7 1242 std r6, VCPU_DAR(r9) 1243 stw r7, VCPU_DSISR(r9) 1244 /* don't overwrite fault_dar/fault_dsisr if HDSI */ 1245 cmpwi r12,BOOK3S_INTERRUPT_H_DATA_STORAGE 1246 beq mc_cont 1247 std r6, VCPU_FAULT_DAR(r9) 1248 stw r7, VCPU_FAULT_DSISR(r9) 1249 1250 /* See if it is a machine check */ 1251 cmpwi r12, BOOK3S_INTERRUPT_MACHINE_CHECK 1252 beq machine_check_realmode 1253mc_cont: 1254#ifdef CONFIG_KVM_BOOK3S_HV_EXIT_TIMING 1255 addi r3, r9, VCPU_TB_RMEXIT 1256 mr r4, r9 1257 bl kvmhv_accumulate_time 1258#endif 1259 1260 /* Increment exit count, poke other threads to exit */ 1261 bl kvmhv_commence_exit 1262 nop 1263 ld r9, HSTATE_KVM_VCPU(r13) 1264 lwz r12, VCPU_TRAP(r9) 1265 1266 /* Stop others sending VCPU interrupts to this physical CPU */ 1267 li r0, -1 1268 stw r0, VCPU_CPU(r9) 1269 stw r0, VCPU_THREAD_CPU(r9) 1270 1271 /* Save guest CTRL register, set runlatch to 1 */ 1272 mfspr r6,SPRN_CTRLF 1273 stw r6,VCPU_CTRL(r9) 1274 andi. r0,r6,1 1275 bne 4f 1276 ori r6,r6,1 1277 mtspr SPRN_CTRLT,r6 12784: 1279 /* Read the guest SLB and save it away */ 1280 lwz r0,VCPU_SLB_NR(r9) /* number of entries in SLB */ 1281 mtctr r0 1282 li r6,0 1283 addi r7,r9,VCPU_SLB 1284 li r5,0 12851: slbmfee r8,r6 1286 andis. r0,r8,SLB_ESID_V@h 1287 beq 2f 1288 add r8,r8,r6 /* put index in */ 1289 slbmfev r3,r6 1290 std r8,VCPU_SLB_E(r7) 1291 std r3,VCPU_SLB_V(r7) 1292 addi r7,r7,VCPU_SLB_SIZE 1293 addi r5,r5,1 12942: addi r6,r6,1 1295 bdnz 1b 1296 stw r5,VCPU_SLB_MAX(r9) 1297 1298 /* 1299 * Save the guest PURR/SPURR 1300 */ 1301 mfspr r5,SPRN_PURR 1302 mfspr r6,SPRN_SPURR 1303 ld r7,VCPU_PURR(r9) 1304 ld r8,VCPU_SPURR(r9) 1305 std r5,VCPU_PURR(r9) 1306 std r6,VCPU_SPURR(r9) 1307 subf r5,r7,r5 1308 subf r6,r8,r6 1309 1310 /* 1311 * Restore host PURR/SPURR and add guest times 1312 * so that the time in the guest gets accounted. 1313 */ 1314 ld r3,HSTATE_PURR(r13) 1315 ld r4,HSTATE_SPURR(r13) 1316 add r3,r3,r5 1317 add r4,r4,r6 1318 mtspr SPRN_PURR,r3 1319 mtspr SPRN_SPURR,r4 1320 1321 /* Save DEC */ 1322 mfspr r5,SPRN_DEC 1323 mftb r6 1324 extsw r5,r5 1325 add r5,r5,r6 1326 /* r5 is a guest timebase value here, convert to host TB */ 1327 ld r3,HSTATE_KVM_VCORE(r13) 1328 ld r4,VCORE_TB_OFFSET(r3) 1329 subf r5,r4,r5 1330 std r5,VCPU_DEC_EXPIRES(r9) 1331 1332BEGIN_FTR_SECTION 1333 b 8f 1334END_FTR_SECTION_IFCLR(CPU_FTR_ARCH_207S) 1335 /* Save POWER8-specific registers */ 1336 mfspr r5, SPRN_IAMR 1337 mfspr r6, SPRN_PSPB 1338 mfspr r7, SPRN_FSCR 1339 std r5, VCPU_IAMR(r9) 1340 stw r6, VCPU_PSPB(r9) 1341 std r7, VCPU_FSCR(r9) 1342 mfspr r5, SPRN_IC 1343 mfspr r6, SPRN_VTB 1344 mfspr r7, SPRN_TAR 1345 std r5, VCPU_IC(r9) 1346 std r6, VCPU_VTB(r9) 1347 std r7, VCPU_TAR(r9) 1348 mfspr r8, SPRN_EBBHR 1349 std r8, VCPU_EBBHR(r9) 1350 mfspr r5, SPRN_EBBRR 1351 mfspr r6, SPRN_BESCR 1352 mfspr r7, SPRN_CSIGR 1353 mfspr r8, SPRN_TACR 1354 std r5, VCPU_EBBRR(r9) 1355 std r6, VCPU_BESCR(r9) 1356 std r7, VCPU_CSIGR(r9) 1357 std r8, VCPU_TACR(r9) 1358 mfspr r5, SPRN_TCSCR 1359 mfspr r6, SPRN_ACOP 1360 mfspr r7, SPRN_PID 1361 mfspr r8, SPRN_WORT 1362 std r5, VCPU_TCSCR(r9) 1363 std r6, VCPU_ACOP(r9) 1364 stw r7, VCPU_GUEST_PID(r9) 1365 std r8, VCPU_WORT(r9) 13668: 1367 1368 /* Save and reset AMR and UAMOR before turning on the MMU */ 1369 mfspr r5,SPRN_AMR 1370 mfspr r6,SPRN_UAMOR 1371 std r5,VCPU_AMR(r9) 1372 std r6,VCPU_UAMOR(r9) 1373 li r6,0 1374 mtspr SPRN_AMR,r6 1375 1376 /* Switch DSCR back to host value */ 1377 mfspr r8, SPRN_DSCR 1378 ld r7, HSTATE_DSCR(r13) 1379 std r8, VCPU_DSCR(r9) 1380 mtspr SPRN_DSCR, r7 1381 1382 /* Save non-volatile GPRs */ 1383 std r14, VCPU_GPR(R14)(r9) 1384 std r15, VCPU_GPR(R15)(r9) 1385 std r16, VCPU_GPR(R16)(r9) 1386 std r17, VCPU_GPR(R17)(r9) 1387 std r18, VCPU_GPR(R18)(r9) 1388 std r19, VCPU_GPR(R19)(r9) 1389 std r20, VCPU_GPR(R20)(r9) 1390 std r21, VCPU_GPR(R21)(r9) 1391 std r22, VCPU_GPR(R22)(r9) 1392 std r23, VCPU_GPR(R23)(r9) 1393 std r24, VCPU_GPR(R24)(r9) 1394 std r25, VCPU_GPR(R25)(r9) 1395 std r26, VCPU_GPR(R26)(r9) 1396 std r27, VCPU_GPR(R27)(r9) 1397 std r28, VCPU_GPR(R28)(r9) 1398 std r29, VCPU_GPR(R29)(r9) 1399 std r30, VCPU_GPR(R30)(r9) 1400 std r31, VCPU_GPR(R31)(r9) 1401 1402 /* Save SPRGs */ 1403 mfspr r3, SPRN_SPRG0 1404 mfspr r4, SPRN_SPRG1 1405 mfspr r5, SPRN_SPRG2 1406 mfspr r6, SPRN_SPRG3 1407 std r3, VCPU_SPRG0(r9) 1408 std r4, VCPU_SPRG1(r9) 1409 std r5, VCPU_SPRG2(r9) 1410 std r6, VCPU_SPRG3(r9) 1411 1412 /* save FP state */ 1413 mr r3, r9 1414 bl kvmppc_save_fp 1415 1416#ifdef CONFIG_PPC_TRANSACTIONAL_MEM 1417BEGIN_FTR_SECTION 1418 b 2f 1419END_FTR_SECTION_IFCLR(CPU_FTR_TM) 1420 /* Turn on TM. */ 1421 mfmsr r8 1422 li r0, 1 1423 rldimi r8, r0, MSR_TM_LG, 63-MSR_TM_LG 1424 mtmsrd r8 1425 1426 ld r5, VCPU_MSR(r9) 1427 rldicl. r5, r5, 64 - MSR_TS_S_LG, 62 1428 beq 1f /* TM not active in guest. */ 1429 1430 li r3, TM_CAUSE_KVM_RESCHED 1431 1432 /* Clear the MSR RI since r1, r13 are all going to be foobar. */ 1433 li r5, 0 1434 mtmsrd r5, 1 1435 1436 /* All GPRs are volatile at this point. */ 1437 TRECLAIM(R3) 1438 1439 /* Temporarily store r13 and r9 so we have some regs to play with */ 1440 SET_SCRATCH0(r13) 1441 GET_PACA(r13) 1442 std r9, PACATMSCRATCH(r13) 1443 ld r9, HSTATE_KVM_VCPU(r13) 1444 1445 /* Get a few more GPRs free. */ 1446 std r29, VCPU_GPRS_TM(29)(r9) 1447 std r30, VCPU_GPRS_TM(30)(r9) 1448 std r31, VCPU_GPRS_TM(31)(r9) 1449 1450 /* Save away PPR and DSCR soon so don't run with user values. */ 1451 mfspr r31, SPRN_PPR 1452 HMT_MEDIUM 1453 mfspr r30, SPRN_DSCR 1454 ld r29, HSTATE_DSCR(r13) 1455 mtspr SPRN_DSCR, r29 1456 1457 /* Save all but r9, r13 & r29-r31 */ 1458 reg = 0 1459 .rept 29 1460 .if (reg != 9) && (reg != 13) 1461 std reg, VCPU_GPRS_TM(reg)(r9) 1462 .endif 1463 reg = reg + 1 1464 .endr 1465 /* ... now save r13 */ 1466 GET_SCRATCH0(r4) 1467 std r4, VCPU_GPRS_TM(13)(r9) 1468 /* ... and save r9 */ 1469 ld r4, PACATMSCRATCH(r13) 1470 std r4, VCPU_GPRS_TM(9)(r9) 1471 1472 /* Reload stack pointer and TOC. */ 1473 ld r1, HSTATE_HOST_R1(r13) 1474 ld r2, PACATOC(r13) 1475 1476 /* Set MSR RI now we have r1 and r13 back. */ 1477 li r5, MSR_RI 1478 mtmsrd r5, 1 1479 1480 /* Save away checkpinted SPRs. */ 1481 std r31, VCPU_PPR_TM(r9) 1482 std r30, VCPU_DSCR_TM(r9) 1483 mflr r5 1484 mfcr r6 1485 mfctr r7 1486 mfspr r8, SPRN_AMR 1487 mfspr r10, SPRN_TAR 1488 std r5, VCPU_LR_TM(r9) 1489 stw r6, VCPU_CR_TM(r9) 1490 std r7, VCPU_CTR_TM(r9) 1491 std r8, VCPU_AMR_TM(r9) 1492 std r10, VCPU_TAR_TM(r9) 1493 1494 /* Restore r12 as trap number. */ 1495 lwz r12, VCPU_TRAP(r9) 1496 1497 /* Save FP/VSX. */ 1498 addi r3, r9, VCPU_FPRS_TM 1499 bl store_fp_state 1500 addi r3, r9, VCPU_VRS_TM 1501 bl store_vr_state 1502 mfspr r6, SPRN_VRSAVE 1503 stw r6, VCPU_VRSAVE_TM(r9) 15041: 1505 /* 1506 * We need to save these SPRs after the treclaim so that the software 1507 * error code is recorded correctly in the TEXASR. Also the user may 1508 * change these outside of a transaction, so they must always be 1509 * context switched. 1510 */ 1511 mfspr r5, SPRN_TFHAR 1512 mfspr r6, SPRN_TFIAR 1513 mfspr r7, SPRN_TEXASR 1514 std r5, VCPU_TFHAR(r9) 1515 std r6, VCPU_TFIAR(r9) 1516 std r7, VCPU_TEXASR(r9) 15172: 1518#endif 1519 1520 /* Increment yield count if they have a VPA */ 1521 ld r8, VCPU_VPA(r9) /* do they have a VPA? */ 1522 cmpdi r8, 0 1523 beq 25f 1524 li r4, LPPACA_YIELDCOUNT 1525 LWZX_BE r3, r8, r4 1526 addi r3, r3, 1 1527 STWX_BE r3, r8, r4 1528 li r3, 1 1529 stb r3, VCPU_VPA_DIRTY(r9) 153025: 1531 /* Save PMU registers if requested */ 1532 /* r8 and cr0.eq are live here */ 1533BEGIN_FTR_SECTION 1534 /* 1535 * POWER8 seems to have a hardware bug where setting 1536 * MMCR0[PMAE] along with MMCR0[PMC1CE] and/or MMCR0[PMCjCE] 1537 * when some counters are already negative doesn't seem 1538 * to cause a performance monitor alert (and hence interrupt). 1539 * The effect of this is that when saving the PMU state, 1540 * if there is no PMU alert pending when we read MMCR0 1541 * before freezing the counters, but one becomes pending 1542 * before we read the counters, we lose it. 1543 * To work around this, we need a way to freeze the counters 1544 * before reading MMCR0. Normally, freezing the counters 1545 * is done by writing MMCR0 (to set MMCR0[FC]) which 1546 * unavoidably writes MMCR0[PMA0] as well. On POWER8, 1547 * we can also freeze the counters using MMCR2, by writing 1548 * 1s to all the counter freeze condition bits (there are 1549 * 9 bits each for 6 counters). 1550 */ 1551 li r3, -1 /* set all freeze bits */ 1552 clrrdi r3, r3, 10 1553 mfspr r10, SPRN_MMCR2 1554 mtspr SPRN_MMCR2, r3 1555 isync 1556END_FTR_SECTION_IFSET(CPU_FTR_ARCH_207S) 1557 li r3, 1 1558 sldi r3, r3, 31 /* MMCR0_FC (freeze counters) bit */ 1559 mfspr r4, SPRN_MMCR0 /* save MMCR0 */ 1560 mtspr SPRN_MMCR0, r3 /* freeze all counters, disable ints */ 1561 mfspr r6, SPRN_MMCRA 1562 /* Clear MMCRA in order to disable SDAR updates */ 1563 li r7, 0 1564 mtspr SPRN_MMCRA, r7 1565 isync 1566 beq 21f /* if no VPA, save PMU stuff anyway */ 1567 lbz r7, LPPACA_PMCINUSE(r8) 1568 cmpwi r7, 0 /* did they ask for PMU stuff to be saved? */ 1569 bne 21f 1570 std r3, VCPU_MMCR(r9) /* if not, set saved MMCR0 to FC */ 1571 b 22f 157221: mfspr r5, SPRN_MMCR1 1573 mfspr r7, SPRN_SIAR 1574 mfspr r8, SPRN_SDAR 1575 std r4, VCPU_MMCR(r9) 1576 std r5, VCPU_MMCR + 8(r9) 1577 std r6, VCPU_MMCR + 16(r9) 1578BEGIN_FTR_SECTION 1579 std r10, VCPU_MMCR + 24(r9) 1580END_FTR_SECTION_IFSET(CPU_FTR_ARCH_207S) 1581 std r7, VCPU_SIAR(r9) 1582 std r8, VCPU_SDAR(r9) 1583 mfspr r3, SPRN_PMC1 1584 mfspr r4, SPRN_PMC2 1585 mfspr r5, SPRN_PMC3 1586 mfspr r6, SPRN_PMC4 1587 mfspr r7, SPRN_PMC5 1588 mfspr r8, SPRN_PMC6 1589 stw r3, VCPU_PMC(r9) 1590 stw r4, VCPU_PMC + 4(r9) 1591 stw r5, VCPU_PMC + 8(r9) 1592 stw r6, VCPU_PMC + 12(r9) 1593 stw r7, VCPU_PMC + 16(r9) 1594 stw r8, VCPU_PMC + 20(r9) 1595BEGIN_FTR_SECTION 1596 mfspr r5, SPRN_SIER 1597 mfspr r6, SPRN_SPMC1 1598 mfspr r7, SPRN_SPMC2 1599 mfspr r8, SPRN_MMCRS 1600 std r5, VCPU_SIER(r9) 1601 stw r6, VCPU_PMC + 24(r9) 1602 stw r7, VCPU_PMC + 28(r9) 1603 std r8, VCPU_MMCR + 32(r9) 1604 lis r4, 0x8000 1605 mtspr SPRN_MMCRS, r4 1606END_FTR_SECTION_IFSET(CPU_FTR_ARCH_207S) 160722: 1608 /* Clear out SLB */ 1609 li r5,0 1610 slbmte r5,r5 1611 slbia 1612 ptesync 1613 1614 /* 1615 * POWER7/POWER8 guest -> host partition switch code. 1616 * We don't have to lock against tlbies but we do 1617 * have to coordinate the hardware threads. 1618 */ 1619kvmhv_switch_to_host: 1620 /* Secondary threads wait for primary to do partition switch */ 1621 ld r5,HSTATE_KVM_VCORE(r13) 1622 ld r4,VCORE_KVM(r5) /* pointer to struct kvm */ 1623 lbz r3,HSTATE_PTID(r13) 1624 cmpwi r3,0 1625 beq 15f 1626 HMT_LOW 162713: lbz r3,VCORE_IN_GUEST(r5) 1628 cmpwi r3,0 1629 bne 13b 1630 HMT_MEDIUM 1631 b 16f 1632 1633 /* Primary thread waits for all the secondaries to exit guest */ 163415: lwz r3,VCORE_ENTRY_EXIT(r5) 1635 rlwinm r0,r3,32-8,0xff 1636 clrldi r3,r3,56 1637 cmpw r3,r0 1638 bne 15b 1639 isync 1640 1641 /* Did we actually switch to the guest at all? */ 1642 lbz r6, VCORE_IN_GUEST(r5) 1643 cmpwi r6, 0 1644 beq 19f 1645 1646 /* Primary thread switches back to host partition */ 1647 ld r6,KVM_HOST_SDR1(r4) 1648 lwz r7,KVM_HOST_LPID(r4) 1649 li r8,LPID_RSVD /* switch to reserved LPID */ 1650 mtspr SPRN_LPID,r8 1651 ptesync 1652 mtspr SPRN_SDR1,r6 /* switch to partition page table */ 1653 mtspr SPRN_LPID,r7 1654 isync 1655 1656BEGIN_FTR_SECTION 1657 /* DPDES is shared between threads */ 1658 mfspr r7, SPRN_DPDES 1659 std r7, VCORE_DPDES(r5) 1660 /* clear DPDES so we don't get guest doorbells in the host */ 1661 li r8, 0 1662 mtspr SPRN_DPDES, r8 1663END_FTR_SECTION_IFSET(CPU_FTR_ARCH_207S) 1664 1665 /* Subtract timebase offset from timebase */ 1666 ld r8,VCORE_TB_OFFSET(r5) 1667 cmpdi r8,0 1668 beq 17f 1669 mftb r6 /* current guest timebase */ 1670 subf r8,r8,r6 1671 mtspr SPRN_TBU40,r8 /* update upper 40 bits */ 1672 mftb r7 /* check if lower 24 bits overflowed */ 1673 clrldi r6,r6,40 1674 clrldi r7,r7,40 1675 cmpld r7,r6 1676 bge 17f 1677 addis r8,r8,0x100 /* if so, increment upper 40 bits */ 1678 mtspr SPRN_TBU40,r8 1679 1680 /* Reset PCR */ 168117: ld r0, VCORE_PCR(r5) 1682 cmpdi r0, 0 1683 beq 18f 1684 li r0, 0 1685 mtspr SPRN_PCR, r0 168618: 1687 /* Signal secondary CPUs to continue */ 1688 stb r0,VCORE_IN_GUEST(r5) 168919: lis r8,0x7fff /* MAX_INT@h */ 1690 mtspr SPRN_HDEC,r8 1691 169216: ld r8,KVM_HOST_LPCR(r4) 1693 mtspr SPRN_LPCR,r8 1694 isync 1695 1696 /* load host SLB entries */ 1697 ld r8,PACA_SLBSHADOWPTR(r13) 1698 1699 .rept SLB_NUM_BOLTED 1700 li r3, SLBSHADOW_SAVEAREA 1701 LDX_BE r5, r8, r3 1702 addi r3, r3, 8 1703 LDX_BE r6, r8, r3 1704 andis. r7,r5,SLB_ESID_V@h 1705 beq 1f 1706 slbmte r6,r5 17071: addi r8,r8,16 1708 .endr 1709 1710#ifdef CONFIG_KVM_BOOK3S_HV_EXIT_TIMING 1711 /* Finish timing, if we have a vcpu */ 1712 ld r4, HSTATE_KVM_VCPU(r13) 1713 cmpdi r4, 0 1714 li r3, 0 1715 beq 2f 1716 bl kvmhv_accumulate_time 17172: 1718#endif 1719 /* Unset guest mode */ 1720 li r0, KVM_GUEST_MODE_NONE 1721 stb r0, HSTATE_IN_GUEST(r13) 1722 1723 ld r0, 112+PPC_LR_STKOFF(r1) 1724 addi r1, r1, 112 1725 mtlr r0 1726 blr 1727 1728/* 1729 * Check whether an HDSI is an HPTE not found fault or something else. 1730 * If it is an HPTE not found fault that is due to the guest accessing 1731 * a page that they have mapped but which we have paged out, then 1732 * we continue on with the guest exit path. In all other cases, 1733 * reflect the HDSI to the guest as a DSI. 1734 */ 1735kvmppc_hdsi: 1736 mfspr r4, SPRN_HDAR 1737 mfspr r6, SPRN_HDSISR 1738 /* HPTE not found fault or protection fault? */ 1739 andis. r0, r6, (DSISR_NOHPTE | DSISR_PROTFAULT)@h 1740 beq 1f /* if not, send it to the guest */ 1741 andi. r0, r11, MSR_DR /* data relocation enabled? */ 1742 beq 3f 1743 clrrdi r0, r4, 28 1744 PPC_SLBFEE_DOT(R5, R0) /* if so, look up SLB */ 1745 bne 1f /* if no SLB entry found */ 17464: std r4, VCPU_FAULT_DAR(r9) 1747 stw r6, VCPU_FAULT_DSISR(r9) 1748 1749 /* Search the hash table. */ 1750 mr r3, r9 /* vcpu pointer */ 1751 li r7, 1 /* data fault */ 1752 bl kvmppc_hpte_hv_fault 1753 ld r9, HSTATE_KVM_VCPU(r13) 1754 ld r10, VCPU_PC(r9) 1755 ld r11, VCPU_MSR(r9) 1756 li r12, BOOK3S_INTERRUPT_H_DATA_STORAGE 1757 cmpdi r3, 0 /* retry the instruction */ 1758 beq 6f 1759 cmpdi r3, -1 /* handle in kernel mode */ 1760 beq guest_exit_cont 1761 cmpdi r3, -2 /* MMIO emulation; need instr word */ 1762 beq 2f 1763 1764 /* Synthesize a DSI for the guest */ 1765 ld r4, VCPU_FAULT_DAR(r9) 1766 mr r6, r3 17671: mtspr SPRN_DAR, r4 1768 mtspr SPRN_DSISR, r6 1769 mtspr SPRN_SRR0, r10 1770 mtspr SPRN_SRR1, r11 1771 li r10, BOOK3S_INTERRUPT_DATA_STORAGE 1772 bl kvmppc_msr_interrupt 1773fast_interrupt_c_return: 17746: ld r7, VCPU_CTR(r9) 1775 ld r8, VCPU_XER(r9) 1776 mtctr r7 1777 mtxer r8 1778 mr r4, r9 1779 b fast_guest_return 1780 17813: ld r5, VCPU_KVM(r9) /* not relocated, use VRMA */ 1782 ld r5, KVM_VRMA_SLB_V(r5) 1783 b 4b 1784 1785 /* If this is for emulated MMIO, load the instruction word */ 17862: li r8, KVM_INST_FETCH_FAILED /* In case lwz faults */ 1787 1788 /* Set guest mode to 'jump over instruction' so if lwz faults 1789 * we'll just continue at the next IP. */ 1790 li r0, KVM_GUEST_MODE_SKIP 1791 stb r0, HSTATE_IN_GUEST(r13) 1792 1793 /* Do the access with MSR:DR enabled */ 1794 mfmsr r3 1795 ori r4, r3, MSR_DR /* Enable paging for data */ 1796 mtmsrd r4 1797 lwz r8, 0(r10) 1798 mtmsrd r3 1799 1800 /* Store the result */ 1801 stw r8, VCPU_LAST_INST(r9) 1802 1803 /* Unset guest mode. */ 1804 li r0, KVM_GUEST_MODE_HOST_HV 1805 stb r0, HSTATE_IN_GUEST(r13) 1806 b guest_exit_cont 1807 1808/* 1809 * Similarly for an HISI, reflect it to the guest as an ISI unless 1810 * it is an HPTE not found fault for a page that we have paged out. 1811 */ 1812kvmppc_hisi: 1813 andis. r0, r11, SRR1_ISI_NOPT@h 1814 beq 1f 1815 andi. r0, r11, MSR_IR /* instruction relocation enabled? */ 1816 beq 3f 1817 clrrdi r0, r10, 28 1818 PPC_SLBFEE_DOT(R5, R0) /* if so, look up SLB */ 1819 bne 1f /* if no SLB entry found */ 18204: 1821 /* Search the hash table. */ 1822 mr r3, r9 /* vcpu pointer */ 1823 mr r4, r10 1824 mr r6, r11 1825 li r7, 0 /* instruction fault */ 1826 bl kvmppc_hpte_hv_fault 1827 ld r9, HSTATE_KVM_VCPU(r13) 1828 ld r10, VCPU_PC(r9) 1829 ld r11, VCPU_MSR(r9) 1830 li r12, BOOK3S_INTERRUPT_H_INST_STORAGE 1831 cmpdi r3, 0 /* retry the instruction */ 1832 beq fast_interrupt_c_return 1833 cmpdi r3, -1 /* handle in kernel mode */ 1834 beq guest_exit_cont 1835 1836 /* Synthesize an ISI for the guest */ 1837 mr r11, r3 18381: mtspr SPRN_SRR0, r10 1839 mtspr SPRN_SRR1, r11 1840 li r10, BOOK3S_INTERRUPT_INST_STORAGE 1841 bl kvmppc_msr_interrupt 1842 b fast_interrupt_c_return 1843 18443: ld r6, VCPU_KVM(r9) /* not relocated, use VRMA */ 1845 ld r5, KVM_VRMA_SLB_V(r6) 1846 b 4b 1847 1848/* 1849 * Try to handle an hcall in real mode. 1850 * Returns to the guest if we handle it, or continues on up to 1851 * the kernel if we can't (i.e. if we don't have a handler for 1852 * it, or if the handler returns H_TOO_HARD). 1853 * 1854 * r5 - r8 contain hcall args, 1855 * r9 = vcpu, r10 = pc, r11 = msr, r12 = trap, r13 = paca 1856 */ 1857hcall_try_real_mode: 1858 ld r3,VCPU_GPR(R3)(r9) 1859 andi. r0,r11,MSR_PR 1860 /* sc 1 from userspace - reflect to guest syscall */ 1861 bne sc_1_fast_return 1862 clrrdi r3,r3,2 1863 cmpldi r3,hcall_real_table_end - hcall_real_table 1864 bge guest_exit_cont 1865 /* See if this hcall is enabled for in-kernel handling */ 1866 ld r4, VCPU_KVM(r9) 1867 srdi r0, r3, 8 /* r0 = (r3 / 4) >> 6 */ 1868 sldi r0, r0, 3 /* index into kvm->arch.enabled_hcalls[] */ 1869 add r4, r4, r0 1870 ld r0, KVM_ENABLED_HCALLS(r4) 1871 rlwinm r4, r3, 32-2, 0x3f /* r4 = (r3 / 4) & 0x3f */ 1872 srd r0, r0, r4 1873 andi. r0, r0, 1 1874 beq guest_exit_cont 1875 /* Get pointer to handler, if any, and call it */ 1876 LOAD_REG_ADDR(r4, hcall_real_table) 1877 lwax r3,r3,r4 1878 cmpwi r3,0 1879 beq guest_exit_cont 1880 add r12,r3,r4 1881 mtctr r12 1882 mr r3,r9 /* get vcpu pointer */ 1883 ld r4,VCPU_GPR(R4)(r9) 1884 bctrl 1885 cmpdi r3,H_TOO_HARD 1886 beq hcall_real_fallback 1887 ld r4,HSTATE_KVM_VCPU(r13) 1888 std r3,VCPU_GPR(R3)(r4) 1889 ld r10,VCPU_PC(r4) 1890 ld r11,VCPU_MSR(r4) 1891 b fast_guest_return 1892 1893sc_1_fast_return: 1894 mtspr SPRN_SRR0,r10 1895 mtspr SPRN_SRR1,r11 1896 li r10, BOOK3S_INTERRUPT_SYSCALL 1897 bl kvmppc_msr_interrupt 1898 mr r4,r9 1899 b fast_guest_return 1900 1901 /* We've attempted a real mode hcall, but it's punted it back 1902 * to userspace. We need to restore some clobbered volatiles 1903 * before resuming the pass-it-to-qemu path */ 1904hcall_real_fallback: 1905 li r12,BOOK3S_INTERRUPT_SYSCALL 1906 ld r9, HSTATE_KVM_VCPU(r13) 1907 1908 b guest_exit_cont 1909 1910 .globl hcall_real_table 1911hcall_real_table: 1912 .long 0 /* 0 - unused */ 1913 .long DOTSYM(kvmppc_h_remove) - hcall_real_table 1914 .long DOTSYM(kvmppc_h_enter) - hcall_real_table 1915 .long DOTSYM(kvmppc_h_read) - hcall_real_table 1916 .long DOTSYM(kvmppc_h_clear_mod) - hcall_real_table 1917 .long DOTSYM(kvmppc_h_clear_ref) - hcall_real_table 1918 .long DOTSYM(kvmppc_h_protect) - hcall_real_table 1919 .long DOTSYM(kvmppc_h_get_tce) - hcall_real_table 1920 .long DOTSYM(kvmppc_h_put_tce) - hcall_real_table 1921 .long 0 /* 0x24 - H_SET_SPRG0 */ 1922 .long DOTSYM(kvmppc_h_set_dabr) - hcall_real_table 1923 .long 0 /* 0x2c */ 1924 .long 0 /* 0x30 */ 1925 .long 0 /* 0x34 */ 1926 .long 0 /* 0x38 */ 1927 .long 0 /* 0x3c */ 1928 .long 0 /* 0x40 */ 1929 .long 0 /* 0x44 */ 1930 .long 0 /* 0x48 */ 1931 .long 0 /* 0x4c */ 1932 .long 0 /* 0x50 */ 1933 .long 0 /* 0x54 */ 1934 .long 0 /* 0x58 */ 1935 .long 0 /* 0x5c */ 1936 .long 0 /* 0x60 */ 1937#ifdef CONFIG_KVM_XICS 1938 .long DOTSYM(kvmppc_rm_h_eoi) - hcall_real_table 1939 .long DOTSYM(kvmppc_rm_h_cppr) - hcall_real_table 1940 .long DOTSYM(kvmppc_rm_h_ipi) - hcall_real_table 1941 .long 0 /* 0x70 - H_IPOLL */ 1942 .long DOTSYM(kvmppc_rm_h_xirr) - hcall_real_table 1943#else 1944 .long 0 /* 0x64 - H_EOI */ 1945 .long 0 /* 0x68 - H_CPPR */ 1946 .long 0 /* 0x6c - H_IPI */ 1947 .long 0 /* 0x70 - H_IPOLL */ 1948 .long 0 /* 0x74 - H_XIRR */ 1949#endif 1950 .long 0 /* 0x78 */ 1951 .long 0 /* 0x7c */ 1952 .long 0 /* 0x80 */ 1953 .long 0 /* 0x84 */ 1954 .long 0 /* 0x88 */ 1955 .long 0 /* 0x8c */ 1956 .long 0 /* 0x90 */ 1957 .long 0 /* 0x94 */ 1958 .long 0 /* 0x98 */ 1959 .long 0 /* 0x9c */ 1960 .long 0 /* 0xa0 */ 1961 .long 0 /* 0xa4 */ 1962 .long 0 /* 0xa8 */ 1963 .long 0 /* 0xac */ 1964 .long 0 /* 0xb0 */ 1965 .long 0 /* 0xb4 */ 1966 .long 0 /* 0xb8 */ 1967 .long 0 /* 0xbc */ 1968 .long 0 /* 0xc0 */ 1969 .long 0 /* 0xc4 */ 1970 .long 0 /* 0xc8 */ 1971 .long 0 /* 0xcc */ 1972 .long 0 /* 0xd0 */ 1973 .long 0 /* 0xd4 */ 1974 .long 0 /* 0xd8 */ 1975 .long 0 /* 0xdc */ 1976 .long DOTSYM(kvmppc_h_cede) - hcall_real_table 1977 .long DOTSYM(kvmppc_rm_h_confer) - hcall_real_table 1978 .long 0 /* 0xe8 */ 1979 .long 0 /* 0xec */ 1980 .long 0 /* 0xf0 */ 1981 .long 0 /* 0xf4 */ 1982 .long 0 /* 0xf8 */ 1983 .long 0 /* 0xfc */ 1984 .long 0 /* 0x100 */ 1985 .long 0 /* 0x104 */ 1986 .long 0 /* 0x108 */ 1987 .long 0 /* 0x10c */ 1988 .long 0 /* 0x110 */ 1989 .long 0 /* 0x114 */ 1990 .long 0 /* 0x118 */ 1991 .long 0 /* 0x11c */ 1992 .long 0 /* 0x120 */ 1993 .long DOTSYM(kvmppc_h_bulk_remove) - hcall_real_table 1994 .long 0 /* 0x128 */ 1995 .long 0 /* 0x12c */ 1996 .long 0 /* 0x130 */ 1997 .long DOTSYM(kvmppc_h_set_xdabr) - hcall_real_table 1998 .long 0 /* 0x138 */ 1999 .long 0 /* 0x13c */ 2000 .long 0 /* 0x140 */ 2001 .long 0 /* 0x144 */ 2002 .long 0 /* 0x148 */ 2003 .long 0 /* 0x14c */ 2004 .long 0 /* 0x150 */ 2005 .long 0 /* 0x154 */ 2006 .long 0 /* 0x158 */ 2007 .long 0 /* 0x15c */ 2008 .long 0 /* 0x160 */ 2009 .long 0 /* 0x164 */ 2010 .long 0 /* 0x168 */ 2011 .long 0 /* 0x16c */ 2012 .long 0 /* 0x170 */ 2013 .long 0 /* 0x174 */ 2014 .long 0 /* 0x178 */ 2015 .long 0 /* 0x17c */ 2016 .long 0 /* 0x180 */ 2017 .long 0 /* 0x184 */ 2018 .long 0 /* 0x188 */ 2019 .long 0 /* 0x18c */ 2020 .long 0 /* 0x190 */ 2021 .long 0 /* 0x194 */ 2022 .long 0 /* 0x198 */ 2023 .long 0 /* 0x19c */ 2024 .long 0 /* 0x1a0 */ 2025 .long 0 /* 0x1a4 */ 2026 .long 0 /* 0x1a8 */ 2027 .long 0 /* 0x1ac */ 2028 .long 0 /* 0x1b0 */ 2029 .long 0 /* 0x1b4 */ 2030 .long 0 /* 0x1b8 */ 2031 .long 0 /* 0x1bc */ 2032 .long 0 /* 0x1c0 */ 2033 .long 0 /* 0x1c4 */ 2034 .long 0 /* 0x1c8 */ 2035 .long 0 /* 0x1cc */ 2036 .long 0 /* 0x1d0 */ 2037 .long 0 /* 0x1d4 */ 2038 .long 0 /* 0x1d8 */ 2039 .long 0 /* 0x1dc */ 2040 .long 0 /* 0x1e0 */ 2041 .long 0 /* 0x1e4 */ 2042 .long 0 /* 0x1e8 */ 2043 .long 0 /* 0x1ec */ 2044 .long 0 /* 0x1f0 */ 2045 .long 0 /* 0x1f4 */ 2046 .long 0 /* 0x1f8 */ 2047 .long 0 /* 0x1fc */ 2048 .long 0 /* 0x200 */ 2049 .long 0 /* 0x204 */ 2050 .long 0 /* 0x208 */ 2051 .long 0 /* 0x20c */ 2052 .long 0 /* 0x210 */ 2053 .long 0 /* 0x214 */ 2054 .long 0 /* 0x218 */ 2055 .long 0 /* 0x21c */ 2056 .long 0 /* 0x220 */ 2057 .long 0 /* 0x224 */ 2058 .long 0 /* 0x228 */ 2059 .long 0 /* 0x22c */ 2060 .long 0 /* 0x230 */ 2061 .long 0 /* 0x234 */ 2062 .long 0 /* 0x238 */ 2063 .long 0 /* 0x23c */ 2064 .long 0 /* 0x240 */ 2065 .long 0 /* 0x244 */ 2066 .long 0 /* 0x248 */ 2067 .long 0 /* 0x24c */ 2068 .long 0 /* 0x250 */ 2069 .long 0 /* 0x254 */ 2070 .long 0 /* 0x258 */ 2071 .long 0 /* 0x25c */ 2072 .long 0 /* 0x260 */ 2073 .long 0 /* 0x264 */ 2074 .long 0 /* 0x268 */ 2075 .long 0 /* 0x26c */ 2076 .long 0 /* 0x270 */ 2077 .long 0 /* 0x274 */ 2078 .long 0 /* 0x278 */ 2079 .long 0 /* 0x27c */ 2080 .long 0 /* 0x280 */ 2081 .long 0 /* 0x284 */ 2082 .long 0 /* 0x288 */ 2083 .long 0 /* 0x28c */ 2084 .long 0 /* 0x290 */ 2085 .long 0 /* 0x294 */ 2086 .long 0 /* 0x298 */ 2087 .long 0 /* 0x29c */ 2088 .long 0 /* 0x2a0 */ 2089 .long 0 /* 0x2a4 */ 2090 .long 0 /* 0x2a8 */ 2091 .long 0 /* 0x2ac */ 2092 .long 0 /* 0x2b0 */ 2093 .long 0 /* 0x2b4 */ 2094 .long 0 /* 0x2b8 */ 2095 .long 0 /* 0x2bc */ 2096 .long 0 /* 0x2c0 */ 2097 .long 0 /* 0x2c4 */ 2098 .long 0 /* 0x2c8 */ 2099 .long 0 /* 0x2cc */ 2100 .long 0 /* 0x2d0 */ 2101 .long 0 /* 0x2d4 */ 2102 .long 0 /* 0x2d8 */ 2103 .long 0 /* 0x2dc */ 2104 .long 0 /* 0x2e0 */ 2105 .long 0 /* 0x2e4 */ 2106 .long 0 /* 0x2e8 */ 2107 .long 0 /* 0x2ec */ 2108 .long 0 /* 0x2f0 */ 2109 .long 0 /* 0x2f4 */ 2110 .long 0 /* 0x2f8 */ 2111 .long 0 /* 0x2fc */ 2112 .long DOTSYM(kvmppc_h_random) - hcall_real_table 2113 .globl hcall_real_table_end 2114hcall_real_table_end: 2115 2116_GLOBAL(kvmppc_h_set_xdabr) 2117 andi. r0, r5, DABRX_USER | DABRX_KERNEL 2118 beq 6f 2119 li r0, DABRX_USER | DABRX_KERNEL | DABRX_BTI 2120 andc. r0, r5, r0 2121 beq 3f 21226: li r3, H_PARAMETER 2123 blr 2124 2125_GLOBAL(kvmppc_h_set_dabr) 2126 li r5, DABRX_USER | DABRX_KERNEL 21273: 2128BEGIN_FTR_SECTION 2129 b 2f 2130END_FTR_SECTION_IFSET(CPU_FTR_ARCH_207S) 2131 std r4,VCPU_DABR(r3) 2132 stw r5, VCPU_DABRX(r3) 2133 mtspr SPRN_DABRX, r5 2134 /* Work around P7 bug where DABR can get corrupted on mtspr */ 21351: mtspr SPRN_DABR,r4 2136 mfspr r5, SPRN_DABR 2137 cmpd r4, r5 2138 bne 1b 2139 isync 2140 li r3,0 2141 blr 2142 2143 /* Emulate H_SET_DABR/X on P8 for the sake of compat mode guests */ 21442: rlwimi r5, r4, 5, DAWRX_DR | DAWRX_DW 2145 rlwimi r5, r4, 1, DAWRX_WT 2146 clrrdi r4, r4, 3 2147 std r4, VCPU_DAWR(r3) 2148 std r5, VCPU_DAWRX(r3) 2149 mtspr SPRN_DAWR, r4 2150 mtspr SPRN_DAWRX, r5 2151 li r3, 0 2152 blr 2153 2154_GLOBAL(kvmppc_h_cede) /* r3 = vcpu pointer, r11 = msr, r13 = paca */ 2155 ori r11,r11,MSR_EE 2156 std r11,VCPU_MSR(r3) 2157 li r0,1 2158 stb r0,VCPU_CEDED(r3) 2159 sync /* order setting ceded vs. testing prodded */ 2160 lbz r5,VCPU_PRODDED(r3) 2161 cmpwi r5,0 2162 bne kvm_cede_prodded 2163 li r12,0 /* set trap to 0 to say hcall is handled */ 2164 stw r12,VCPU_TRAP(r3) 2165 li r0,H_SUCCESS 2166 std r0,VCPU_GPR(R3)(r3) 2167 2168 /* 2169 * Set our bit in the bitmask of napping threads unless all the 2170 * other threads are already napping, in which case we send this 2171 * up to the host. 2172 */ 2173 ld r5,HSTATE_KVM_VCORE(r13) 2174 lbz r6,HSTATE_PTID(r13) 2175 lwz r8,VCORE_ENTRY_EXIT(r5) 2176 clrldi r8,r8,56 2177 li r0,1 2178 sld r0,r0,r6 2179 addi r6,r5,VCORE_NAPPING_THREADS 218031: lwarx r4,0,r6 2181 or r4,r4,r0 2182 cmpw r4,r8 2183 beq kvm_cede_exit 2184 stwcx. r4,0,r6 2185 bne 31b 2186 /* order napping_threads update vs testing entry_exit_map */ 2187 isync 2188 li r0,NAPPING_CEDE 2189 stb r0,HSTATE_NAPPING(r13) 2190 lwz r7,VCORE_ENTRY_EXIT(r5) 2191 cmpwi r7,0x100 2192 bge 33f /* another thread already exiting */ 2193 2194/* 2195 * Although not specifically required by the architecture, POWER7 2196 * preserves the following registers in nap mode, even if an SMT mode 2197 * switch occurs: SLB entries, PURR, SPURR, AMOR, UAMOR, AMR, SPRG0-3, 2198 * DAR, DSISR, DABR, DABRX, DSCR, PMCx, MMCRx, SIAR, SDAR. 2199 */ 2200 /* Save non-volatile GPRs */ 2201 std r14, VCPU_GPR(R14)(r3) 2202 std r15, VCPU_GPR(R15)(r3) 2203 std r16, VCPU_GPR(R16)(r3) 2204 std r17, VCPU_GPR(R17)(r3) 2205 std r18, VCPU_GPR(R18)(r3) 2206 std r19, VCPU_GPR(R19)(r3) 2207 std r20, VCPU_GPR(R20)(r3) 2208 std r21, VCPU_GPR(R21)(r3) 2209 std r22, VCPU_GPR(R22)(r3) 2210 std r23, VCPU_GPR(R23)(r3) 2211 std r24, VCPU_GPR(R24)(r3) 2212 std r25, VCPU_GPR(R25)(r3) 2213 std r26, VCPU_GPR(R26)(r3) 2214 std r27, VCPU_GPR(R27)(r3) 2215 std r28, VCPU_GPR(R28)(r3) 2216 std r29, VCPU_GPR(R29)(r3) 2217 std r30, VCPU_GPR(R30)(r3) 2218 std r31, VCPU_GPR(R31)(r3) 2219 2220 /* save FP state */ 2221 bl kvmppc_save_fp 2222 2223 /* 2224 * Set DEC to the smaller of DEC and HDEC, so that we wake 2225 * no later than the end of our timeslice (HDEC interrupts 2226 * don't wake us from nap). 2227 */ 2228 mfspr r3, SPRN_DEC 2229 mfspr r4, SPRN_HDEC 2230 mftb r5 2231 cmpw r3, r4 2232 ble 67f 2233 mtspr SPRN_DEC, r4 223467: 2235 /* save expiry time of guest decrementer */ 2236 extsw r3, r3 2237 add r3, r3, r5 2238 ld r4, HSTATE_KVM_VCPU(r13) 2239 ld r5, HSTATE_KVM_VCORE(r13) 2240 ld r6, VCORE_TB_OFFSET(r5) 2241 subf r3, r6, r3 /* convert to host TB value */ 2242 std r3, VCPU_DEC_EXPIRES(r4) 2243 2244#ifdef CONFIG_KVM_BOOK3S_HV_EXIT_TIMING 2245 ld r4, HSTATE_KVM_VCPU(r13) 2246 addi r3, r4, VCPU_TB_CEDE 2247 bl kvmhv_accumulate_time 2248#endif 2249 2250 lis r3, LPCR_PECEDP@h /* Do wake on privileged doorbell */ 2251 2252 /* 2253 * Take a nap until a decrementer or external or doobell interrupt 2254 * occurs, with PECE1 and PECE0 set in LPCR. 2255 * On POWER8, set PECEDH, and if we are ceding, also set PECEDP. 2256 * Also clear the runlatch bit before napping. 2257 */ 2258kvm_do_nap: 2259 mfspr r0, SPRN_CTRLF 2260 clrrdi r0, r0, 1 2261 mtspr SPRN_CTRLT, r0 2262 2263 li r0,1 2264 stb r0,HSTATE_HWTHREAD_REQ(r13) 2265 mfspr r5,SPRN_LPCR 2266 ori r5,r5,LPCR_PECE0 | LPCR_PECE1 2267BEGIN_FTR_SECTION 2268 ori r5, r5, LPCR_PECEDH 2269 rlwimi r5, r3, 0, LPCR_PECEDP 2270END_FTR_SECTION_IFSET(CPU_FTR_ARCH_207S) 2271 mtspr SPRN_LPCR,r5 2272 isync 2273 li r0, 0 2274 std r0, HSTATE_SCRATCH0(r13) 2275 ptesync 2276 ld r0, HSTATE_SCRATCH0(r13) 22771: cmpd r0, r0 2278 bne 1b 2279 nap 2280 b . 2281 228233: mr r4, r3 2283 li r3, 0 2284 li r12, 0 2285 b 34f 2286 2287kvm_end_cede: 2288 /* get vcpu pointer */ 2289 ld r4, HSTATE_KVM_VCPU(r13) 2290 2291 /* Woken by external or decrementer interrupt */ 2292 ld r1, HSTATE_HOST_R1(r13) 2293 2294#ifdef CONFIG_KVM_BOOK3S_HV_EXIT_TIMING 2295 addi r3, r4, VCPU_TB_RMINTR 2296 bl kvmhv_accumulate_time 2297#endif 2298 2299 /* load up FP state */ 2300 bl kvmppc_load_fp 2301 2302 /* Restore guest decrementer */ 2303 ld r3, VCPU_DEC_EXPIRES(r4) 2304 ld r5, HSTATE_KVM_VCORE(r13) 2305 ld r6, VCORE_TB_OFFSET(r5) 2306 add r3, r3, r6 /* convert host TB to guest TB value */ 2307 mftb r7 2308 subf r3, r7, r3 2309 mtspr SPRN_DEC, r3 2310 2311 /* Load NV GPRS */ 2312 ld r14, VCPU_GPR(R14)(r4) 2313 ld r15, VCPU_GPR(R15)(r4) 2314 ld r16, VCPU_GPR(R16)(r4) 2315 ld r17, VCPU_GPR(R17)(r4) 2316 ld r18, VCPU_GPR(R18)(r4) 2317 ld r19, VCPU_GPR(R19)(r4) 2318 ld r20, VCPU_GPR(R20)(r4) 2319 ld r21, VCPU_GPR(R21)(r4) 2320 ld r22, VCPU_GPR(R22)(r4) 2321 ld r23, VCPU_GPR(R23)(r4) 2322 ld r24, VCPU_GPR(R24)(r4) 2323 ld r25, VCPU_GPR(R25)(r4) 2324 ld r26, VCPU_GPR(R26)(r4) 2325 ld r27, VCPU_GPR(R27)(r4) 2326 ld r28, VCPU_GPR(R28)(r4) 2327 ld r29, VCPU_GPR(R29)(r4) 2328 ld r30, VCPU_GPR(R30)(r4) 2329 ld r31, VCPU_GPR(R31)(r4) 2330 2331 /* Check the wake reason in SRR1 to see why we got here */ 2332 bl kvmppc_check_wake_reason 2333 2334 /* clear our bit in vcore->napping_threads */ 233534: ld r5,HSTATE_KVM_VCORE(r13) 2336 lbz r7,HSTATE_PTID(r13) 2337 li r0,1 2338 sld r0,r0,r7 2339 addi r6,r5,VCORE_NAPPING_THREADS 234032: lwarx r7,0,r6 2341 andc r7,r7,r0 2342 stwcx. r7,0,r6 2343 bne 32b 2344 li r0,0 2345 stb r0,HSTATE_NAPPING(r13) 2346 2347 /* See if the wake reason means we need to exit */ 2348 stw r12, VCPU_TRAP(r4) 2349 mr r9, r4 2350 cmpdi r3, 0 2351 bgt guest_exit_cont 2352 2353 /* see if any other thread is already exiting */ 2354 lwz r0,VCORE_ENTRY_EXIT(r5) 2355 cmpwi r0,0x100 2356 bge guest_exit_cont 2357 2358 b kvmppc_cede_reentry /* if not go back to guest */ 2359 2360 /* cede when already previously prodded case */ 2361kvm_cede_prodded: 2362 li r0,0 2363 stb r0,VCPU_PRODDED(r3) 2364 sync /* order testing prodded vs. clearing ceded */ 2365 stb r0,VCPU_CEDED(r3) 2366 li r3,H_SUCCESS 2367 blr 2368 2369 /* we've ceded but we want to give control to the host */ 2370kvm_cede_exit: 2371 ld r9, HSTATE_KVM_VCPU(r13) 2372 b guest_exit_cont 2373 2374 /* Try to handle a machine check in real mode */ 2375machine_check_realmode: 2376 mr r3, r9 /* get vcpu pointer */ 2377 bl kvmppc_realmode_machine_check 2378 nop 2379 cmpdi r3, 0 /* Did we handle MCE ? */ 2380 ld r9, HSTATE_KVM_VCPU(r13) 2381 li r12, BOOK3S_INTERRUPT_MACHINE_CHECK 2382 /* 2383 * Deliver unhandled/fatal (e.g. UE) MCE errors to guest through 2384 * machine check interrupt (set HSRR0 to 0x200). And for handled 2385 * errors (no-fatal), just go back to guest execution with current 2386 * HSRR0 instead of exiting guest. This new approach will inject 2387 * machine check to guest for fatal error causing guest to crash. 2388 * 2389 * The old code used to return to host for unhandled errors which 2390 * was causing guest to hang with soft lockups inside guest and 2391 * makes it difficult to recover guest instance. 2392 */ 2393 ld r10, VCPU_PC(r9) 2394 ld r11, VCPU_MSR(r9) 2395 bne 2f /* Continue guest execution. */ 2396 /* If not, deliver a machine check. SRR0/1 are already set */ 2397 li r10, BOOK3S_INTERRUPT_MACHINE_CHECK 2398 ld r11, VCPU_MSR(r9) 2399 bl kvmppc_msr_interrupt 24002: b fast_interrupt_c_return 2401 2402/* 2403 * Check the reason we woke from nap, and take appropriate action. 2404 * Returns (in r3): 2405 * 0 if nothing needs to be done 2406 * 1 if something happened that needs to be handled by the host 2407 * -1 if there was a guest wakeup (IPI or msgsnd) 2408 * 2409 * Also sets r12 to the interrupt vector for any interrupt that needs 2410 * to be handled now by the host (0x500 for external interrupt), or zero. 2411 * Modifies r0, r6, r7, r8. 2412 */ 2413kvmppc_check_wake_reason: 2414 mfspr r6, SPRN_SRR1 2415BEGIN_FTR_SECTION 2416 rlwinm r6, r6, 45-31, 0xf /* extract wake reason field (P8) */ 2417FTR_SECTION_ELSE 2418 rlwinm r6, r6, 45-31, 0xe /* P7 wake reason field is 3 bits */ 2419ALT_FTR_SECTION_END_IFSET(CPU_FTR_ARCH_207S) 2420 cmpwi r6, 8 /* was it an external interrupt? */ 2421 li r12, BOOK3S_INTERRUPT_EXTERNAL 2422 beq kvmppc_read_intr /* if so, see what it was */ 2423 li r3, 0 2424 li r12, 0 2425 cmpwi r6, 6 /* was it the decrementer? */ 2426 beq 0f 2427BEGIN_FTR_SECTION 2428 cmpwi r6, 5 /* privileged doorbell? */ 2429 beq 0f 2430 cmpwi r6, 3 /* hypervisor doorbell? */ 2431 beq 3f 2432END_FTR_SECTION_IFSET(CPU_FTR_ARCH_207S) 2433 li r3, 1 /* anything else, return 1 */ 24340: blr 2435 2436 /* hypervisor doorbell */ 24373: li r12, BOOK3S_INTERRUPT_H_DOORBELL 2438 /* see if it's a host IPI */ 2439 li r3, 1 2440 lbz r0, HSTATE_HOST_IPI(r13) 2441 cmpwi r0, 0 2442 bnelr 2443 /* if not, clear it and return -1 */ 2444 lis r6, (PPC_DBELL_SERVER << (63-36))@h 2445 PPC_MSGCLR(6) 2446 li r3, -1 2447 blr 2448 2449/* 2450 * Determine what sort of external interrupt is pending (if any). 2451 * Returns: 2452 * 0 if no interrupt is pending 2453 * 1 if an interrupt is pending that needs to be handled by the host 2454 * -1 if there was a guest wakeup IPI (which has now been cleared) 2455 * Modifies r0, r6, r7, r8, returns value in r3. 2456 */ 2457kvmppc_read_intr: 2458 /* see if a host IPI is pending */ 2459 li r3, 1 2460 lbz r0, HSTATE_HOST_IPI(r13) 2461 cmpwi r0, 0 2462 bne 1f 2463 2464 /* Now read the interrupt from the ICP */ 2465 ld r6, HSTATE_XICS_PHYS(r13) 2466 li r7, XICS_XIRR 2467 cmpdi r6, 0 2468 beq- 1f 2469 lwzcix r0, r6, r7 2470 /* 2471 * Save XIRR for later. Since we get in in reverse endian on LE 2472 * systems, save it byte reversed and fetch it back in host endian. 2473 */ 2474 li r3, HSTATE_SAVED_XIRR 2475 STWX_BE r0, r3, r13 2476#ifdef __LITTLE_ENDIAN__ 2477 lwz r3, HSTATE_SAVED_XIRR(r13) 2478#else 2479 mr r3, r0 2480#endif 2481 rlwinm. r3, r3, 0, 0xffffff 2482 sync 2483 beq 1f /* if nothing pending in the ICP */ 2484 2485 /* We found something in the ICP... 2486 * 2487 * If it's not an IPI, stash it in the PACA and return to 2488 * the host, we don't (yet) handle directing real external 2489 * interrupts directly to the guest 2490 */ 2491 cmpwi r3, XICS_IPI /* if there is, is it an IPI? */ 2492 bne 42f 2493 2494 /* It's an IPI, clear the MFRR and EOI it */ 2495 li r3, 0xff 2496 li r8, XICS_MFRR 2497 stbcix r3, r6, r8 /* clear the IPI */ 2498 stwcix r0, r6, r7 /* EOI it */ 2499 sync 2500 2501 /* We need to re-check host IPI now in case it got set in the 2502 * meantime. If it's clear, we bounce the interrupt to the 2503 * guest 2504 */ 2505 lbz r0, HSTATE_HOST_IPI(r13) 2506 cmpwi r0, 0 2507 bne- 43f 2508 2509 /* OK, it's an IPI for us */ 2510 li r12, 0 2511 li r3, -1 25121: blr 2513 251442: /* It's not an IPI and it's for the host. We saved a copy of XIRR in 2515 * the PACA earlier, it will be picked up by the host ICP driver 2516 */ 2517 li r3, 1 2518 b 1b 2519 252043: /* We raced with the host, we need to resend that IPI, bummer */ 2521 li r0, IPI_PRIORITY 2522 stbcix r0, r6, r8 /* set the IPI */ 2523 sync 2524 li r3, 1 2525 b 1b 2526 2527/* 2528 * Save away FP, VMX and VSX registers. 2529 * r3 = vcpu pointer 2530 * N.B. r30 and r31 are volatile across this function, 2531 * thus it is not callable from C. 2532 */ 2533kvmppc_save_fp: 2534 mflr r30 2535 mr r31,r3 2536 mfmsr r5 2537 ori r8,r5,MSR_FP 2538#ifdef CONFIG_ALTIVEC 2539BEGIN_FTR_SECTION 2540 oris r8,r8,MSR_VEC@h 2541END_FTR_SECTION_IFSET(CPU_FTR_ALTIVEC) 2542#endif 2543#ifdef CONFIG_VSX 2544BEGIN_FTR_SECTION 2545 oris r8,r8,MSR_VSX@h 2546END_FTR_SECTION_IFSET(CPU_FTR_VSX) 2547#endif 2548 mtmsrd r8 2549 addi r3,r3,VCPU_FPRS 2550 bl store_fp_state 2551#ifdef CONFIG_ALTIVEC 2552BEGIN_FTR_SECTION 2553 addi r3,r31,VCPU_VRS 2554 bl store_vr_state 2555END_FTR_SECTION_IFSET(CPU_FTR_ALTIVEC) 2556#endif 2557 mfspr r6,SPRN_VRSAVE 2558 stw r6,VCPU_VRSAVE(r31) 2559 mtlr r30 2560 blr 2561 2562/* 2563 * Load up FP, VMX and VSX registers 2564 * r4 = vcpu pointer 2565 * N.B. r30 and r31 are volatile across this function, 2566 * thus it is not callable from C. 2567 */ 2568kvmppc_load_fp: 2569 mflr r30 2570 mr r31,r4 2571 mfmsr r9 2572 ori r8,r9,MSR_FP 2573#ifdef CONFIG_ALTIVEC 2574BEGIN_FTR_SECTION 2575 oris r8,r8,MSR_VEC@h 2576END_FTR_SECTION_IFSET(CPU_FTR_ALTIVEC) 2577#endif 2578#ifdef CONFIG_VSX 2579BEGIN_FTR_SECTION 2580 oris r8,r8,MSR_VSX@h 2581END_FTR_SECTION_IFSET(CPU_FTR_VSX) 2582#endif 2583 mtmsrd r8 2584 addi r3,r4,VCPU_FPRS 2585 bl load_fp_state 2586#ifdef CONFIG_ALTIVEC 2587BEGIN_FTR_SECTION 2588 addi r3,r31,VCPU_VRS 2589 bl load_vr_state 2590END_FTR_SECTION_IFSET(CPU_FTR_ALTIVEC) 2591#endif 2592 lwz r7,VCPU_VRSAVE(r31) 2593 mtspr SPRN_VRSAVE,r7 2594 mtlr r30 2595 mr r4,r31 2596 blr 2597 2598/* 2599 * We come here if we get any exception or interrupt while we are 2600 * executing host real mode code while in guest MMU context. 2601 * For now just spin, but we should do something better. 2602 */ 2603kvmppc_bad_host_intr: 2604 b . 2605 2606/* 2607 * This mimics the MSR transition on IRQ delivery. The new guest MSR is taken 2608 * from VCPU_INTR_MSR and is modified based on the required TM state changes. 2609 * r11 has the guest MSR value (in/out) 2610 * r9 has a vcpu pointer (in) 2611 * r0 is used as a scratch register 2612 */ 2613kvmppc_msr_interrupt: 2614 rldicl r0, r11, 64 - MSR_TS_S_LG, 62 2615 cmpwi r0, 2 /* Check if we are in transactional state.. */ 2616 ld r11, VCPU_INTR_MSR(r9) 2617 bne 1f 2618 /* ... if transactional, change to suspended */ 2619 li r0, 1 26201: rldimi r11, r0, MSR_TS_S_LG, 63 - MSR_TS_T_LG 2621 blr 2622 2623/* 2624 * This works around a hardware bug on POWER8E processors, where 2625 * writing a 1 to the MMCR0[PMAO] bit doesn't generate a 2626 * performance monitor interrupt. Instead, when we need to have 2627 * an interrupt pending, we have to arrange for a counter to overflow. 2628 */ 2629kvmppc_fix_pmao: 2630 li r3, 0 2631 mtspr SPRN_MMCR2, r3 2632 lis r3, (MMCR0_PMXE | MMCR0_FCECE)@h 2633 ori r3, r3, MMCR0_PMCjCE | MMCR0_C56RUN 2634 mtspr SPRN_MMCR0, r3 2635 lis r3, 0x7fff 2636 ori r3, r3, 0xffff 2637 mtspr SPRN_PMC6, r3 2638 isync 2639 blr 2640 2641#ifdef CONFIG_KVM_BOOK3S_HV_EXIT_TIMING 2642/* 2643 * Start timing an activity 2644 * r3 = pointer to time accumulation struct, r4 = vcpu 2645 */ 2646kvmhv_start_timing: 2647 ld r5, HSTATE_KVM_VCORE(r13) 2648 lbz r6, VCORE_IN_GUEST(r5) 2649 cmpwi r6, 0 2650 beq 5f /* if in guest, need to */ 2651 ld r6, VCORE_TB_OFFSET(r5) /* subtract timebase offset */ 26525: mftb r5 2653 subf r5, r6, r5 2654 std r3, VCPU_CUR_ACTIVITY(r4) 2655 std r5, VCPU_ACTIVITY_START(r4) 2656 blr 2657 2658/* 2659 * Accumulate time to one activity and start another. 2660 * r3 = pointer to new time accumulation struct, r4 = vcpu 2661 */ 2662kvmhv_accumulate_time: 2663 ld r5, HSTATE_KVM_VCORE(r13) 2664 lbz r8, VCORE_IN_GUEST(r5) 2665 cmpwi r8, 0 2666 beq 4f /* if in guest, need to */ 2667 ld r8, VCORE_TB_OFFSET(r5) /* subtract timebase offset */ 26684: ld r5, VCPU_CUR_ACTIVITY(r4) 2669 ld r6, VCPU_ACTIVITY_START(r4) 2670 std r3, VCPU_CUR_ACTIVITY(r4) 2671 mftb r7 2672 subf r7, r8, r7 2673 std r7, VCPU_ACTIVITY_START(r4) 2674 cmpdi r5, 0 2675 beqlr 2676 subf r3, r6, r7 2677 ld r8, TAS_SEQCOUNT(r5) 2678 cmpdi r8, 0 2679 addi r8, r8, 1 2680 std r8, TAS_SEQCOUNT(r5) 2681 lwsync 2682 ld r7, TAS_TOTAL(r5) 2683 add r7, r7, r3 2684 std r7, TAS_TOTAL(r5) 2685 ld r6, TAS_MIN(r5) 2686 ld r7, TAS_MAX(r5) 2687 beq 3f 2688 cmpd r3, r6 2689 bge 1f 26903: std r3, TAS_MIN(r5) 26911: cmpd r3, r7 2692 ble 2f 2693 std r3, TAS_MAX(r5) 26942: lwsync 2695 addi r8, r8, 1 2696 std r8, TAS_SEQCOUNT(r5) 2697 blr 2698#endif 2699