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