| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 1 | /* | 
|  | 2 | * Copyright (C) 2008 Freescale Semiconductor, Inc. All rights reserved. | 
|  | 3 | * | 
|  | 4 | * Author: Yu Liu, <yu.liu@freescale.com> | 
|  | 5 | * | 
|  | 6 | * Description: | 
|  | 7 | * This file is derived from arch/powerpc/kvm/44x_emulate.c, | 
|  | 8 | * by Hollis Blanchard <hollisb@us.ibm.com>. | 
|  | 9 | * | 
|  | 10 | * This program is free software; you can redistribute it and/or modify | 
|  | 11 | * it under the terms of the GNU General Public License, version 2, as | 
|  | 12 | * published by the Free Software Foundation. | 
|  | 13 | */ | 
|  | 14 |  | 
|  | 15 | #include <asm/kvm_ppc.h> | 
|  | 16 | #include <asm/disassemble.h> | 
|  | 17 | #include <asm/kvm_e500.h> | 
|  | 18 |  | 
|  | 19 | #include "booke.h" | 
|  | 20 | #include "e500_tlb.h" | 
|  | 21 |  | 
|  | 22 | #define XOP_TLBIVAX 786 | 
|  | 23 | #define XOP_TLBSX   914 | 
|  | 24 | #define XOP_TLBRE   946 | 
|  | 25 | #define XOP_TLBWE   978 | 
|  | 26 |  | 
|  | 27 | int kvmppc_core_emulate_op(struct kvm_run *run, struct kvm_vcpu *vcpu, | 
|  | 28 | unsigned int inst, int *advance) | 
|  | 29 | { | 
|  | 30 | int emulated = EMULATE_DONE; | 
|  | 31 | int ra; | 
|  | 32 | int rb; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 33 |  | 
|  | 34 | switch (get_op(inst)) { | 
|  | 35 | case 31: | 
|  | 36 | switch (get_xop(inst)) { | 
|  | 37 |  | 
|  | 38 | case XOP_TLBRE: | 
|  | 39 | emulated = kvmppc_e500_emul_tlbre(vcpu); | 
|  | 40 | break; | 
|  | 41 |  | 
|  | 42 | case XOP_TLBWE: | 
|  | 43 | emulated = kvmppc_e500_emul_tlbwe(vcpu); | 
|  | 44 | break; | 
|  | 45 |  | 
|  | 46 | case XOP_TLBSX: | 
|  | 47 | rb = get_rb(inst); | 
|  | 48 | emulated = kvmppc_e500_emul_tlbsx(vcpu,rb); | 
|  | 49 | break; | 
|  | 50 |  | 
|  | 51 | case XOP_TLBIVAX: | 
|  | 52 | ra = get_ra(inst); | 
|  | 53 | rb = get_rb(inst); | 
|  | 54 | emulated = kvmppc_e500_emul_tlbivax(vcpu, ra, rb); | 
|  | 55 | break; | 
|  | 56 |  | 
|  | 57 | default: | 
|  | 58 | emulated = EMULATE_FAIL; | 
|  | 59 | } | 
|  | 60 |  | 
|  | 61 | break; | 
|  | 62 |  | 
|  | 63 | default: | 
|  | 64 | emulated = EMULATE_FAIL; | 
|  | 65 | } | 
|  | 66 |  | 
|  | 67 | if (emulated == EMULATE_FAIL) | 
|  | 68 | emulated = kvmppc_booke_emulate_op(run, vcpu, inst, advance); | 
|  | 69 |  | 
|  | 70 | return emulated; | 
|  | 71 | } | 
|  | 72 |  | 
|  | 73 | int kvmppc_core_emulate_mtspr(struct kvm_vcpu *vcpu, int sprn, int rs) | 
|  | 74 | { | 
|  | 75 | struct kvmppc_vcpu_e500 *vcpu_e500 = to_e500(vcpu); | 
|  | 76 | int emulated = EMULATE_DONE; | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 77 | ulong spr_val = kvmppc_get_gpr(vcpu, rs); | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 78 |  | 
|  | 79 | switch (sprn) { | 
|  | 80 | case SPRN_PID: | 
|  | 81 | vcpu_e500->pid[0] = vcpu->arch.shadow_pid = | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 82 | vcpu->arch.pid = spr_val; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 83 | break; | 
|  | 84 | case SPRN_PID1: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 85 | vcpu_e500->pid[1] = spr_val; break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 86 | case SPRN_PID2: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 87 | vcpu_e500->pid[2] = spr_val; break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 88 | case SPRN_MAS0: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 89 | vcpu_e500->mas0 = spr_val; break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 90 | case SPRN_MAS1: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 91 | vcpu_e500->mas1 = spr_val; break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 92 | case SPRN_MAS2: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 93 | vcpu_e500->mas2 = spr_val; break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 94 | case SPRN_MAS3: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 95 | vcpu_e500->mas3 = spr_val; break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 96 | case SPRN_MAS4: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 97 | vcpu_e500->mas4 = spr_val; break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 98 | case SPRN_MAS6: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 99 | vcpu_e500->mas6 = spr_val; break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 100 | case SPRN_MAS7: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 101 | vcpu_e500->mas7 = spr_val; break; | 
| Liu Yu | d86be07 | 2010-01-22 18:50:29 +0800 | [diff] [blame] | 102 | case SPRN_L1CSR0: | 
|  | 103 | vcpu_e500->l1csr0 = spr_val; | 
|  | 104 | vcpu_e500->l1csr0 &= ~(L1CSR0_DCFI | L1CSR0_CLFC); | 
|  | 105 | break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 106 | case SPRN_L1CSR1: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 107 | vcpu_e500->l1csr1 = spr_val; break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 108 | case SPRN_HID0: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 109 | vcpu_e500->hid0 = spr_val; break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 110 | case SPRN_HID1: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 111 | vcpu_e500->hid1 = spr_val; break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 112 |  | 
| Liu Yu | b0a1835 | 2009-02-17 16:52:08 +0800 | [diff] [blame] | 113 | case SPRN_MMUCSR0: | 
|  | 114 | emulated = kvmppc_e500_emul_mt_mmucsr0(vcpu_e500, | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 115 | spr_val); | 
| Liu Yu | b0a1835 | 2009-02-17 16:52:08 +0800 | [diff] [blame] | 116 | break; | 
|  | 117 |  | 
| Hollis Blanchard | bb3a8a1 | 2009-01-03 16:23:13 -0600 | [diff] [blame] | 118 | /* extra exceptions */ | 
|  | 119 | case SPRN_IVOR32: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 120 | vcpu->arch.ivor[BOOKE_IRQPRIO_SPE_UNAVAIL] = spr_val; | 
| Hollis Blanchard | bb3a8a1 | 2009-01-03 16:23:13 -0600 | [diff] [blame] | 121 | break; | 
|  | 122 | case SPRN_IVOR33: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 123 | vcpu->arch.ivor[BOOKE_IRQPRIO_SPE_FP_DATA] = spr_val; | 
| Hollis Blanchard | bb3a8a1 | 2009-01-03 16:23:13 -0600 | [diff] [blame] | 124 | break; | 
|  | 125 | case SPRN_IVOR34: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 126 | vcpu->arch.ivor[BOOKE_IRQPRIO_SPE_FP_ROUND] = spr_val; | 
| Hollis Blanchard | bb3a8a1 | 2009-01-03 16:23:13 -0600 | [diff] [blame] | 127 | break; | 
|  | 128 | case SPRN_IVOR35: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 129 | vcpu->arch.ivor[BOOKE_IRQPRIO_PERFORMANCE_MONITOR] = spr_val; | 
| Hollis Blanchard | bb3a8a1 | 2009-01-03 16:23:13 -0600 | [diff] [blame] | 130 | break; | 
|  | 131 |  | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 132 | default: | 
|  | 133 | emulated = kvmppc_booke_emulate_mtspr(vcpu, sprn, rs); | 
|  | 134 | } | 
|  | 135 |  | 
|  | 136 | return emulated; | 
|  | 137 | } | 
|  | 138 |  | 
|  | 139 | int kvmppc_core_emulate_mfspr(struct kvm_vcpu *vcpu, int sprn, int rt) | 
|  | 140 | { | 
|  | 141 | struct kvmppc_vcpu_e500 *vcpu_e500 = to_e500(vcpu); | 
|  | 142 | int emulated = EMULATE_DONE; | 
|  | 143 |  | 
|  | 144 | switch (sprn) { | 
|  | 145 | case SPRN_PID: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 146 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->pid[0]); break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 147 | case SPRN_PID1: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 148 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->pid[1]); break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 149 | case SPRN_PID2: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 150 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->pid[2]); break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 151 | case SPRN_MAS0: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 152 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->mas0); break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 153 | case SPRN_MAS1: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 154 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->mas1); break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 155 | case SPRN_MAS2: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 156 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->mas2); break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 157 | case SPRN_MAS3: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 158 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->mas3); break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 159 | case SPRN_MAS4: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 160 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->mas4); break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 161 | case SPRN_MAS6: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 162 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->mas6); break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 163 | case SPRN_MAS7: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 164 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->mas7); break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 165 |  | 
|  | 166 | case SPRN_TLB0CFG: | 
| Liu Yu | da15bf4 | 2010-01-22 19:36:53 +0800 | [diff] [blame] | 167 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->tlb0cfg); break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 168 | case SPRN_TLB1CFG: | 
| Liu Yu | da15bf4 | 2010-01-22 19:36:53 +0800 | [diff] [blame] | 169 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->tlb1cfg); break; | 
| Liu Yu | d86be07 | 2010-01-22 18:50:29 +0800 | [diff] [blame] | 170 | case SPRN_L1CSR0: | 
|  | 171 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->l1csr0); break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 172 | case SPRN_L1CSR1: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 173 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->l1csr1); break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 174 | case SPRN_HID0: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 175 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->hid0); break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 176 | case SPRN_HID1: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 177 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->hid1); break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 178 |  | 
| Liu Yu | b0a1835 | 2009-02-17 16:52:08 +0800 | [diff] [blame] | 179 | case SPRN_MMUCSR0: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 180 | kvmppc_set_gpr(vcpu, rt, 0); break; | 
| Liu Yu | b0a1835 | 2009-02-17 16:52:08 +0800 | [diff] [blame] | 181 |  | 
| Liu Yu | 06579dd | 2009-06-05 14:54:31 +0800 | [diff] [blame] | 182 | case SPRN_MMUCFG: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 183 | kvmppc_set_gpr(vcpu, rt, mfspr(SPRN_MMUCFG)); break; | 
| Liu Yu | 06579dd | 2009-06-05 14:54:31 +0800 | [diff] [blame] | 184 |  | 
| Hollis Blanchard | bb3a8a1 | 2009-01-03 16:23:13 -0600 | [diff] [blame] | 185 | /* extra exceptions */ | 
|  | 186 | case SPRN_IVOR32: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 187 | kvmppc_set_gpr(vcpu, rt, vcpu->arch.ivor[BOOKE_IRQPRIO_SPE_UNAVAIL]); | 
| Hollis Blanchard | bb3a8a1 | 2009-01-03 16:23:13 -0600 | [diff] [blame] | 188 | break; | 
|  | 189 | case SPRN_IVOR33: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 190 | kvmppc_set_gpr(vcpu, rt, vcpu->arch.ivor[BOOKE_IRQPRIO_SPE_FP_DATA]); | 
| Hollis Blanchard | bb3a8a1 | 2009-01-03 16:23:13 -0600 | [diff] [blame] | 191 | break; | 
|  | 192 | case SPRN_IVOR34: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 193 | kvmppc_set_gpr(vcpu, rt, vcpu->arch.ivor[BOOKE_IRQPRIO_SPE_FP_ROUND]); | 
| Hollis Blanchard | bb3a8a1 | 2009-01-03 16:23:13 -0600 | [diff] [blame] | 194 | break; | 
|  | 195 | case SPRN_IVOR35: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 196 | kvmppc_set_gpr(vcpu, rt, vcpu->arch.ivor[BOOKE_IRQPRIO_PERFORMANCE_MONITOR]); | 
| Hollis Blanchard | bb3a8a1 | 2009-01-03 16:23:13 -0600 | [diff] [blame] | 197 | break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 198 | default: | 
|  | 199 | emulated = kvmppc_booke_emulate_mfspr(vcpu, sprn, rt); | 
|  | 200 | } | 
|  | 201 |  | 
|  | 202 | return emulated; | 
|  | 203 | } | 
|  | 204 |  |