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