1 /* 2 * Copyright (C) 2008-2011 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; 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; 77 ulong spr_val = kvmppc_get_gpr(vcpu, rs); 78 79 switch (sprn) { 80 case SPRN_PID: 81 kvmppc_set_pid(vcpu, spr_val); 82 break; 83 case SPRN_PID1: 84 if (spr_val != 0) 85 return EMULATE_FAIL; 86 vcpu_e500->pid[1] = spr_val; break; 87 case SPRN_PID2: 88 if (spr_val != 0) 89 return EMULATE_FAIL; 90 vcpu_e500->pid[2] = spr_val; break; 91 case SPRN_MAS0: 92 vcpu_e500->mas0 = spr_val; break; 93 case SPRN_MAS1: 94 vcpu_e500->mas1 = spr_val; break; 95 case SPRN_MAS2: 96 vcpu_e500->mas2 = spr_val; break; 97 case SPRN_MAS3: 98 vcpu_e500->mas3 = spr_val; break; 99 case SPRN_MAS4: 100 vcpu_e500->mas4 = spr_val; break; 101 case SPRN_MAS6: 102 vcpu_e500->mas6 = spr_val; break; 103 case SPRN_MAS7: 104 vcpu_e500->mas7 = spr_val; break; 105 case SPRN_L1CSR0: 106 vcpu_e500->l1csr0 = spr_val; 107 vcpu_e500->l1csr0 &= ~(L1CSR0_DCFI | L1CSR0_CLFC); 108 break; 109 case SPRN_L1CSR1: 110 vcpu_e500->l1csr1 = spr_val; break; 111 case SPRN_HID0: 112 vcpu_e500->hid0 = spr_val; break; 113 case SPRN_HID1: 114 vcpu_e500->hid1 = spr_val; break; 115 116 case SPRN_MMUCSR0: 117 emulated = kvmppc_e500_emul_mt_mmucsr0(vcpu_e500, 118 spr_val); 119 break; 120 121 /* extra exceptions */ 122 case SPRN_IVOR32: 123 vcpu->arch.ivor[BOOKE_IRQPRIO_SPE_UNAVAIL] = spr_val; 124 break; 125 case SPRN_IVOR33: 126 vcpu->arch.ivor[BOOKE_IRQPRIO_SPE_FP_DATA] = spr_val; 127 break; 128 case SPRN_IVOR34: 129 vcpu->arch.ivor[BOOKE_IRQPRIO_SPE_FP_ROUND] = spr_val; 130 break; 131 case SPRN_IVOR35: 132 vcpu->arch.ivor[BOOKE_IRQPRIO_PERFORMANCE_MONITOR] = spr_val; 133 break; 134 135 default: 136 emulated = kvmppc_booke_emulate_mtspr(vcpu, sprn, rs); 137 } 138 139 return emulated; 140 } 141 142 int kvmppc_core_emulate_mfspr(struct kvm_vcpu *vcpu, int sprn, int rt) 143 { 144 struct kvmppc_vcpu_e500 *vcpu_e500 = to_e500(vcpu); 145 int emulated = EMULATE_DONE; 146 147 switch (sprn) { 148 case SPRN_PID: 149 kvmppc_set_gpr(vcpu, rt, vcpu_e500->pid[0]); break; 150 case SPRN_PID1: 151 kvmppc_set_gpr(vcpu, rt, vcpu_e500->pid[1]); break; 152 case SPRN_PID2: 153 kvmppc_set_gpr(vcpu, rt, vcpu_e500->pid[2]); break; 154 case SPRN_MAS0: 155 kvmppc_set_gpr(vcpu, rt, vcpu_e500->mas0); break; 156 case SPRN_MAS1: 157 kvmppc_set_gpr(vcpu, rt, vcpu_e500->mas1); break; 158 case SPRN_MAS2: 159 kvmppc_set_gpr(vcpu, rt, vcpu_e500->mas2); break; 160 case SPRN_MAS3: 161 kvmppc_set_gpr(vcpu, rt, vcpu_e500->mas3); break; 162 case SPRN_MAS4: 163 kvmppc_set_gpr(vcpu, rt, vcpu_e500->mas4); break; 164 case SPRN_MAS6: 165 kvmppc_set_gpr(vcpu, rt, vcpu_e500->mas6); break; 166 case SPRN_MAS7: 167 kvmppc_set_gpr(vcpu, rt, vcpu_e500->mas7); break; 168 169 case SPRN_TLB0CFG: 170 kvmppc_set_gpr(vcpu, rt, vcpu_e500->tlb0cfg); break; 171 case SPRN_TLB1CFG: 172 kvmppc_set_gpr(vcpu, rt, vcpu_e500->tlb1cfg); break; 173 case SPRN_L1CSR0: 174 kvmppc_set_gpr(vcpu, rt, vcpu_e500->l1csr0); break; 175 case SPRN_L1CSR1: 176 kvmppc_set_gpr(vcpu, rt, vcpu_e500->l1csr1); break; 177 case SPRN_HID0: 178 kvmppc_set_gpr(vcpu, rt, vcpu_e500->hid0); break; 179 case SPRN_HID1: 180 kvmppc_set_gpr(vcpu, rt, vcpu_e500->hid1); break; 181 case SPRN_SVR: 182 kvmppc_set_gpr(vcpu, rt, vcpu_e500->svr); break; 183 184 case SPRN_MMUCSR0: 185 kvmppc_set_gpr(vcpu, rt, 0); break; 186 187 case SPRN_MMUCFG: 188 kvmppc_set_gpr(vcpu, rt, mfspr(SPRN_MMUCFG)); break; 189 190 /* extra exceptions */ 191 case SPRN_IVOR32: 192 kvmppc_set_gpr(vcpu, rt, vcpu->arch.ivor[BOOKE_IRQPRIO_SPE_UNAVAIL]); 193 break; 194 case SPRN_IVOR33: 195 kvmppc_set_gpr(vcpu, rt, vcpu->arch.ivor[BOOKE_IRQPRIO_SPE_FP_DATA]); 196 break; 197 case SPRN_IVOR34: 198 kvmppc_set_gpr(vcpu, rt, vcpu->arch.ivor[BOOKE_IRQPRIO_SPE_FP_ROUND]); 199 break; 200 case SPRN_IVOR35: 201 kvmppc_set_gpr(vcpu, rt, vcpu->arch.ivor[BOOKE_IRQPRIO_PERFORMANCE_MONITOR]); 202 break; 203 default: 204 emulated = kvmppc_booke_emulate_mfspr(vcpu, sprn, rt); 205 } 206 207 return emulated; 208 } 209 210