arch/powerpc/kvm/e500_emulate.c

   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
  18 #include "booke.h"
  19 #include "e500.h"
  20
  21 #define XOP_TLBIVAX 786
  22 #define XOP_TLBSX   914
  23 #define XOP_TLBRE   946
  24 #define XOP_TLBWE   978
  25 #define XOP_TLBILX  18
  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         int rt;
  34
  35         switch (get_op(inst)) {
  36         case 31:
  37                 switch (get_xop(inst)) {
  38
  39                 case XOP_TLBRE:
  40                         emulated = kvmppc_e500_emul_tlbre(vcpu);
  41                         break;
  42
  43                 case XOP_TLBWE:
  44                         emulated = kvmppc_e500_emul_tlbwe(vcpu);
  45                         break;
  46
  47                 case XOP_TLBSX:
  48                         rb = get_rb(inst);
  49                         emulated = kvmppc_e500_emul_tlbsx(vcpu,rb);
  50                         break;
  51
  52                 case XOP_TLBILX:
  53                         ra = get_ra(inst);
  54                         rb = get_rb(inst);
  55                         rt = get_rt(inst);
  56                         emulated = kvmppc_e500_emul_tlbilx(vcpu, rt, ra, rb);
  57                         break;
  58
  59                 case XOP_TLBIVAX:
  60                         ra = get_ra(inst);
  61                         rb = get_rb(inst);
  62                         emulated = kvmppc_e500_emul_tlbivax(vcpu, ra, rb);
  63                         break;
  64
  65                 default:
  66                         emulated = EMULATE_FAIL;
  67                 }
  68
  69                 break;
  70
  71         default:
  72                 emulated = EMULATE_FAIL;
  73         }
  74
  75         if (emulated == EMULATE_FAIL)
  76                 emulated = kvmppc_booke_emulate_op(run, vcpu, inst, advance);
  77
  78         return emulated;
  79 }
  80
  81 int kvmppc_core_emulate_mtspr(struct kvm_vcpu *vcpu, int sprn, int rs)
  82 {
  83         struct kvmppc_vcpu_e500 *vcpu_e500 = to_e500(vcpu);
  84         int emulated = EMULATE_DONE;
  85         ulong spr_val = kvmppc_get_gpr(vcpu, rs);
  86
  87         switch (sprn) {
  88         case SPRN_PID:
  89                 kvmppc_set_pid(vcpu, spr_val);
  90                 break;
  91         case SPRN_PID1:
  92                 if (spr_val != 0)
  93                         return EMULATE_FAIL;
  94                 vcpu_e500->pid[1] = spr_val; break;
  95         case SPRN_PID2:
  96                 if (spr_val != 0)
  97                         return EMULATE_FAIL;
  98                 vcpu_e500->pid[2] = spr_val; break;
  99         case SPRN_MAS0:
 100                 vcpu->arch.shared->mas0 = spr_val; break;
 101         case SPRN_MAS1:
 102                 vcpu->arch.shared->mas1 = spr_val; break;
 103         case SPRN_MAS2:
 104                 vcpu->arch.shared->mas2 = spr_val; break;
 105         case SPRN_MAS3:
 106                 vcpu->arch.shared->mas7_3 &= ~(u64)0xffffffff;
 107                 vcpu->arch.shared->mas7_3 |= spr_val;
 108                 break;
 109         case SPRN_MAS4:
 110                 vcpu->arch.shared->mas4 = spr_val; break;
 111         case SPRN_MAS6:
 112                 vcpu->arch.shared->mas6 = spr_val; break;
 113         case SPRN_MAS7:
 114                 vcpu->arch.shared->mas7_3 &= (u64)0xffffffff;
 115                 vcpu->arch.shared->mas7_3 |= (u64)spr_val << 32;
 116                 break;
 117         case SPRN_L1CSR0:
 118                 vcpu_e500->l1csr0 = spr_val;
 119                 vcpu_e500->l1csr0 &= ~(L1CSR0_DCFI | L1CSR0_CLFC);
 120                 break;
 121         case SPRN_L1CSR1:
 122                 vcpu_e500->l1csr1 = spr_val; break;
 123         case SPRN_HID0:
 124                 vcpu_e500->hid0 = spr_val; break;
 125         case SPRN_HID1:
 126                 vcpu_e500->hid1 = spr_val; break;
 127
 128         case SPRN_MMUCSR0:
 129                 emulated = kvmppc_e500_emul_mt_mmucsr0(vcpu_e500,
 130                                 spr_val);
 131                 break;
 132
 133         /* extra exceptions */
 134         case SPRN_IVOR32:
 135                 vcpu->arch.ivor[BOOKE_IRQPRIO_SPE_UNAVAIL] = spr_val;
 136                 break;
 137         case SPRN_IVOR33:
 138                 vcpu->arch.ivor[BOOKE_IRQPRIO_SPE_FP_DATA] = spr_val;
 139                 break;
 140         case SPRN_IVOR34:
 141                 vcpu->arch.ivor[BOOKE_IRQPRIO_SPE_FP_ROUND] = spr_val;
 142                 break;
 143         case SPRN_IVOR35:
 144                 vcpu->arch.ivor[BOOKE_IRQPRIO_PERFORMANCE_MONITOR] = spr_val;
 145                 break;
 146
 147         default:
 148                 emulated = kvmppc_booke_emulate_mtspr(vcpu, sprn, rs);
 149         }
 150
 151         return emulated;
 152 }
 153
 154 int kvmppc_core_emulate_mfspr(struct kvm_vcpu *vcpu, int sprn, int rt)
 155 {
 156         struct kvmppc_vcpu_e500 *vcpu_e500 = to_e500(vcpu);
 157         int emulated = EMULATE_DONE;
 158         unsigned long val;
 159
 160         switch (sprn) {
 161         case SPRN_PID:
 162                 kvmppc_set_gpr(vcpu, rt, vcpu_e500->pid[0]); break;
 163         case SPRN_PID1:
 164                 kvmppc_set_gpr(vcpu, rt, vcpu_e500->pid[1]); break;
 165         case SPRN_PID2:
 166                 kvmppc_set_gpr(vcpu, rt, vcpu_e500->pid[2]); break;
 167         case SPRN_MAS0:
 168                 kvmppc_set_gpr(vcpu, rt, vcpu->arch.shared->mas0); break;
 169         case SPRN_MAS1:
 170                 kvmppc_set_gpr(vcpu, rt, vcpu->arch.shared->mas1); break;
 171         case SPRN_MAS2:
 172                 kvmppc_set_gpr(vcpu, rt, vcpu->arch.shared->mas2); break;
 173         case SPRN_MAS3:
 174                 val = (u32)vcpu->arch.shared->mas7_3;
 175                 kvmppc_set_gpr(vcpu, rt, val);
 176                 break;
 177         case SPRN_MAS4:
 178                 kvmppc_set_gpr(vcpu, rt, vcpu->arch.shared->mas4); break;
 179         case SPRN_MAS6:
 180                 kvmppc_set_gpr(vcpu, rt, vcpu->arch.shared->mas6); break;
 181         case SPRN_MAS7:
 182                 val = vcpu->arch.shared->mas7_3 >> 32;
 183                 kvmppc_set_gpr(vcpu, rt, val);
 184                 break;
 185         case SPRN_TLB0CFG:
 186                 kvmppc_set_gpr(vcpu, rt, vcpu->arch.tlbcfg[0]); break;
 187         case SPRN_TLB1CFG:
 188                 kvmppc_set_gpr(vcpu, rt, vcpu->arch.tlbcfg[1]); break;
 189         case SPRN_L1CSR0:
 190                 kvmppc_set_gpr(vcpu, rt, vcpu_e500->l1csr0); break;
 191         case SPRN_L1CSR1:
 192                 kvmppc_set_gpr(vcpu, rt, vcpu_e500->l1csr1); break;
 193         case SPRN_HID0:
 194                 kvmppc_set_gpr(vcpu, rt, vcpu_e500->hid0); break;
 195         case SPRN_HID1:
 196                 kvmppc_set_gpr(vcpu, rt, vcpu_e500->hid1); break;
 197         case SPRN_SVR:
 198                 kvmppc_set_gpr(vcpu, rt, vcpu_e500->svr); break;
 199
 200         case SPRN_MMUCSR0:
 201                 kvmppc_set_gpr(vcpu, rt, 0); break;
 202
 203         case SPRN_MMUCFG:
 204                 kvmppc_set_gpr(vcpu, rt, vcpu->arch.mmucfg); break;
 205
 206         /* extra exceptions */
 207         case SPRN_IVOR32:
 208                 kvmppc_set_gpr(vcpu, rt, vcpu->arch.ivor[BOOKE_IRQPRIO_SPE_UNAVAIL]);
 209                 break;
 210         case SPRN_IVOR33:
 211                 kvmppc_set_gpr(vcpu, rt, vcpu->arch.ivor[BOOKE_IRQPRIO_SPE_FP_DATA]);
 212                 break;
 213         case SPRN_IVOR34:
 214                 kvmppc_set_gpr(vcpu, rt, vcpu->arch.ivor[BOOKE_IRQPRIO_SPE_FP_ROUND]);
 215                 break;
 216         case SPRN_IVOR35:
 217                 kvmppc_set_gpr(vcpu, rt, vcpu->arch.ivor[BOOKE_IRQPRIO_PERFORMANCE_MONITOR]);
 218                 break;
 219         default:
 220                 emulated = kvmppc_booke_emulate_mfspr(vcpu, sprn, rt);
 221         }
 222
 223         return emulated;
 224 }
 225