| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 1 | /* | 
| Scott Wood | 5ce941e | 2011-04-27 17:24:21 -0500 | [diff] [blame] | 2 | * Copyright (C) 2008-2011 Freescale Semiconductor, Inc. All rights reserved. | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 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: | 
| Scott Wood | 5ce941e | 2011-04-27 17:24:21 -0500 | [diff] [blame] | 81 | kvmppc_set_pid(vcpu, spr_val); | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 82 | break; | 
|  | 83 | case SPRN_PID1: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 84 | vcpu_e500->pid[1] = spr_val; break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 85 | case SPRN_PID2: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 86 | vcpu_e500->pid[2] = spr_val; break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 87 | case SPRN_MAS0: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 88 | vcpu_e500->mas0 = spr_val; break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 89 | case SPRN_MAS1: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 90 | vcpu_e500->mas1 = spr_val; break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 91 | case SPRN_MAS2: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 92 | vcpu_e500->mas2 = spr_val; break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 93 | case SPRN_MAS3: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 94 | vcpu_e500->mas3 = spr_val; break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 95 | case SPRN_MAS4: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 96 | vcpu_e500->mas4 = spr_val; break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 97 | case SPRN_MAS6: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 98 | vcpu_e500->mas6 = spr_val; break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 99 | case SPRN_MAS7: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 100 | vcpu_e500->mas7 = spr_val; break; | 
| Liu Yu | d86be07 | 2010-01-22 18:50:29 +0800 | [diff] [blame] | 101 | case SPRN_L1CSR0: | 
|  | 102 | vcpu_e500->l1csr0 = spr_val; | 
|  | 103 | vcpu_e500->l1csr0 &= ~(L1CSR0_DCFI | L1CSR0_CLFC); | 
|  | 104 | break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 105 | case SPRN_L1CSR1: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 106 | vcpu_e500->l1csr1 = spr_val; break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 107 | case SPRN_HID0: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 108 | vcpu_e500->hid0 = spr_val; break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 109 | case SPRN_HID1: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 110 | vcpu_e500->hid1 = spr_val; break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 111 |  | 
| Liu Yu | b0a1835 | 2009-02-17 16:52:08 +0800 | [diff] [blame] | 112 | case SPRN_MMUCSR0: | 
|  | 113 | emulated = kvmppc_e500_emul_mt_mmucsr0(vcpu_e500, | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 114 | spr_val); | 
| Liu Yu | b0a1835 | 2009-02-17 16:52:08 +0800 | [diff] [blame] | 115 | break; | 
|  | 116 |  | 
| Hollis Blanchard | bb3a8a1 | 2009-01-03 16:23:13 -0600 | [diff] [blame] | 117 | /* extra exceptions */ | 
|  | 118 | case SPRN_IVOR32: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 119 | vcpu->arch.ivor[BOOKE_IRQPRIO_SPE_UNAVAIL] = spr_val; | 
| Hollis Blanchard | bb3a8a1 | 2009-01-03 16:23:13 -0600 | [diff] [blame] | 120 | break; | 
|  | 121 | case SPRN_IVOR33: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 122 | vcpu->arch.ivor[BOOKE_IRQPRIO_SPE_FP_DATA] = spr_val; | 
| Hollis Blanchard | bb3a8a1 | 2009-01-03 16:23:13 -0600 | [diff] [blame] | 123 | break; | 
|  | 124 | case SPRN_IVOR34: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 125 | vcpu->arch.ivor[BOOKE_IRQPRIO_SPE_FP_ROUND] = spr_val; | 
| Hollis Blanchard | bb3a8a1 | 2009-01-03 16:23:13 -0600 | [diff] [blame] | 126 | break; | 
|  | 127 | case SPRN_IVOR35: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 128 | vcpu->arch.ivor[BOOKE_IRQPRIO_PERFORMANCE_MONITOR] = spr_val; | 
| Hollis Blanchard | bb3a8a1 | 2009-01-03 16:23:13 -0600 | [diff] [blame] | 129 | break; | 
|  | 130 |  | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 131 | default: | 
|  | 132 | emulated = kvmppc_booke_emulate_mtspr(vcpu, sprn, rs); | 
|  | 133 | } | 
|  | 134 |  | 
|  | 135 | return emulated; | 
|  | 136 | } | 
|  | 137 |  | 
|  | 138 | int kvmppc_core_emulate_mfspr(struct kvm_vcpu *vcpu, int sprn, int rt) | 
|  | 139 | { | 
|  | 140 | struct kvmppc_vcpu_e500 *vcpu_e500 = to_e500(vcpu); | 
|  | 141 | int emulated = EMULATE_DONE; | 
|  | 142 |  | 
|  | 143 | switch (sprn) { | 
|  | 144 | case SPRN_PID: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 145 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->pid[0]); break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 146 | case SPRN_PID1: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 147 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->pid[1]); break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 148 | case SPRN_PID2: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 149 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->pid[2]); break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 150 | case SPRN_MAS0: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 151 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->mas0); break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 152 | case SPRN_MAS1: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 153 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->mas1); break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 154 | case SPRN_MAS2: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 155 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->mas2); break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 156 | case SPRN_MAS3: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 157 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->mas3); break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 158 | case SPRN_MAS4: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 159 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->mas4); break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 160 | case SPRN_MAS6: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 161 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->mas6); break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 162 | case SPRN_MAS7: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 163 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->mas7); break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 164 |  | 
|  | 165 | case SPRN_TLB0CFG: | 
| Liu Yu | da15bf4 | 2010-01-22 19:36:53 +0800 | [diff] [blame] | 166 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->tlb0cfg); break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 167 | case SPRN_TLB1CFG: | 
| Liu Yu | da15bf4 | 2010-01-22 19:36:53 +0800 | [diff] [blame] | 168 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->tlb1cfg); break; | 
| Liu Yu | d86be07 | 2010-01-22 18:50:29 +0800 | [diff] [blame] | 169 | case SPRN_L1CSR0: | 
|  | 170 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->l1csr0); break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 171 | case SPRN_L1CSR1: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 172 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->l1csr1); break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 173 | case SPRN_HID0: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 174 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->hid0); break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 175 | case SPRN_HID1: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 176 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->hid1); break; | 
| Scott Wood | 90d34b0 | 2011-03-29 16:49:10 -0500 | [diff] [blame] | 177 | case SPRN_SVR: | 
|  | 178 | kvmppc_set_gpr(vcpu, rt, vcpu_e500->svr); break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 179 |  | 
| Liu Yu | b0a1835 | 2009-02-17 16:52:08 +0800 | [diff] [blame] | 180 | case SPRN_MMUCSR0: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 181 | kvmppc_set_gpr(vcpu, rt, 0); break; | 
| Liu Yu | b0a1835 | 2009-02-17 16:52:08 +0800 | [diff] [blame] | 182 |  | 
| Liu Yu | 06579dd | 2009-06-05 14:54:31 +0800 | [diff] [blame] | 183 | case SPRN_MMUCFG: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 184 | kvmppc_set_gpr(vcpu, rt, mfspr(SPRN_MMUCFG)); break; | 
| Liu Yu | 06579dd | 2009-06-05 14:54:31 +0800 | [diff] [blame] | 185 |  | 
| Hollis Blanchard | bb3a8a1 | 2009-01-03 16:23:13 -0600 | [diff] [blame] | 186 | /* extra exceptions */ | 
|  | 187 | case SPRN_IVOR32: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 188 | kvmppc_set_gpr(vcpu, rt, vcpu->arch.ivor[BOOKE_IRQPRIO_SPE_UNAVAIL]); | 
| Hollis Blanchard | bb3a8a1 | 2009-01-03 16:23:13 -0600 | [diff] [blame] | 189 | break; | 
|  | 190 | case SPRN_IVOR33: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 191 | 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] | 192 | break; | 
|  | 193 | case SPRN_IVOR34: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 194 | 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] | 195 | break; | 
|  | 196 | case SPRN_IVOR35: | 
| Alexander Graf | 8e5b26b | 2010-01-08 02:58:01 +0100 | [diff] [blame] | 197 | kvmppc_set_gpr(vcpu, rt, vcpu->arch.ivor[BOOKE_IRQPRIO_PERFORMANCE_MONITOR]); | 
| Hollis Blanchard | bb3a8a1 | 2009-01-03 16:23:13 -0600 | [diff] [blame] | 198 | break; | 
| Hollis Blanchard | bc8080c | 2009-01-03 16:23:10 -0600 | [diff] [blame] | 199 | default: | 
|  | 200 | emulated = kvmppc_booke_emulate_mfspr(vcpu, sprn, rt); | 
|  | 201 | } | 
|  | 202 |  | 
|  | 203 | return emulated; | 
|  | 204 | } | 
|  | 205 |  |