| Alexander Graf | c862125 | 2009-10-30 05:47:09 +0000 | [diff] [blame] | 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 | * You should have received a copy of the GNU General Public License |
| 12 | * along with this program; if not, write to the Free Software |
| 13 | * Foundation, 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA. |
| 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/page.h> |
| 24 | #include <asm/asm-offsets.h> |
| 25 | #include <asm/exception-64s.h> |
| 26 | |
| 27 | /***************************************************************************** |
| 28 | * * |
| 29 | * Real Mode handlers that need to be in low physical memory * |
| 30 | * * |
| 31 | ****************************************************************************/ |
| 32 | |
| 33 | |
| 34 | .macro INTERRUPT_TRAMPOLINE intno |
| 35 | |
| 36 | .global kvmppc_trampoline_\intno |
| 37 | kvmppc_trampoline_\intno: |
| 38 | |
| 39 | mtspr SPRN_SPRG_SCRATCH0, r13 /* Save r13 */ |
| 40 | |
| 41 | /* |
| 42 | * First thing to do is to find out if we're coming |
| 43 | * from a KVM guest or a Linux process. |
| 44 | * |
| 45 | * To distinguish, we check a magic byte in the PACA |
| 46 | */ |
| 47 | mfspr r13, SPRN_SPRG_PACA /* r13 = PACA */ |
| 48 | std r12, (PACA_EXMC + EX_R12)(r13) |
| 49 | mfcr r12 |
| 50 | stw r12, (PACA_EXMC + EX_CCR)(r13) |
| 51 | lbz r12, PACA_KVM_IN_GUEST(r13) |
| 52 | cmpwi r12, 0 |
| 53 | bne ..kvmppc_handler_hasmagic_\intno |
| 54 | /* No KVM guest? Then jump back to the Linux handler! */ |
| 55 | lwz r12, (PACA_EXMC + EX_CCR)(r13) |
| 56 | mtcr r12 |
| 57 | ld r12, (PACA_EXMC + EX_R12)(r13) |
| 58 | mfspr r13, SPRN_SPRG_SCRATCH0 /* r13 = original r13 */ |
| 59 | b kvmppc_resume_\intno /* Get back original handler */ |
| 60 | |
| 61 | /* Now we know we're handling a KVM guest */ |
| 62 | ..kvmppc_handler_hasmagic_\intno: |
| 63 | /* Unset guest state */ |
| 64 | li r12, 0 |
| 65 | stb r12, PACA_KVM_IN_GUEST(r13) |
| 66 | |
| 67 | std r1, (PACA_EXMC+EX_R9)(r13) |
| 68 | std r10, (PACA_EXMC+EX_R10)(r13) |
| 69 | std r11, (PACA_EXMC+EX_R11)(r13) |
| 70 | std r2, (PACA_EXMC+EX_R13)(r13) |
| 71 | |
| 72 | mfsrr0 r10 |
| 73 | mfsrr1 r11 |
| 74 | |
| 75 | /* Restore R1/R2 so we can handle faults */ |
| 76 | ld r1, PACAR1(r13) |
| 77 | ld r2, (PACA_EXMC+EX_SRR0)(r13) |
| 78 | |
| 79 | /* Let's store which interrupt we're handling */ |
| 80 | li r12, \intno |
| 81 | |
| 82 | /* Jump into the SLB exit code that goes to the highmem handler */ |
| 83 | b kvmppc_handler_trampoline_exit |
| 84 | |
| 85 | .endm |
| 86 | |
| 87 | INTERRUPT_TRAMPOLINE BOOK3S_INTERRUPT_SYSTEM_RESET |
| 88 | INTERRUPT_TRAMPOLINE BOOK3S_INTERRUPT_MACHINE_CHECK |
| 89 | INTERRUPT_TRAMPOLINE BOOK3S_INTERRUPT_DATA_STORAGE |
| 90 | INTERRUPT_TRAMPOLINE BOOK3S_INTERRUPT_DATA_SEGMENT |
| 91 | INTERRUPT_TRAMPOLINE BOOK3S_INTERRUPT_INST_STORAGE |
| 92 | INTERRUPT_TRAMPOLINE BOOK3S_INTERRUPT_INST_SEGMENT |
| 93 | INTERRUPT_TRAMPOLINE BOOK3S_INTERRUPT_EXTERNAL |
| 94 | INTERRUPT_TRAMPOLINE BOOK3S_INTERRUPT_ALIGNMENT |
| 95 | INTERRUPT_TRAMPOLINE BOOK3S_INTERRUPT_PROGRAM |
| 96 | INTERRUPT_TRAMPOLINE BOOK3S_INTERRUPT_FP_UNAVAIL |
| 97 | INTERRUPT_TRAMPOLINE BOOK3S_INTERRUPT_DECREMENTER |
| 98 | INTERRUPT_TRAMPOLINE BOOK3S_INTERRUPT_SYSCALL |
| 99 | INTERRUPT_TRAMPOLINE BOOK3S_INTERRUPT_TRACE |
| 100 | INTERRUPT_TRAMPOLINE BOOK3S_INTERRUPT_PERFMON |
| 101 | INTERRUPT_TRAMPOLINE BOOK3S_INTERRUPT_ALTIVEC |
| 102 | INTERRUPT_TRAMPOLINE BOOK3S_INTERRUPT_VSX |
| 103 | |
| 104 | /* |
| 105 | * This trampoline brings us back to a real mode handler |
| 106 | * |
| 107 | * Input Registers: |
| 108 | * |
| 109 | * R6 = SRR0 |
| 110 | * R7 = SRR1 |
| 111 | * LR = real-mode IP |
| 112 | * |
| 113 | */ |
| 114 | .global kvmppc_handler_lowmem_trampoline |
| 115 | kvmppc_handler_lowmem_trampoline: |
| 116 | |
| 117 | mtsrr0 r6 |
| 118 | mtsrr1 r7 |
| 119 | blr |
| 120 | kvmppc_handler_lowmem_trampoline_end: |
| 121 | |
| 122 | .global kvmppc_trampoline_lowmem |
| 123 | kvmppc_trampoline_lowmem: |
| 124 | .long kvmppc_handler_lowmem_trampoline - _stext |
| 125 | |
| 126 | .global kvmppc_trampoline_enter |
| 127 | kvmppc_trampoline_enter: |
| 128 | .long kvmppc_handler_trampoline_enter - _stext |
| 129 | |
| 130 | #include "book3s_64_slb.S" |
| 131 | |