arch/powerpc/kvm/booke_emulate.c

   1 /*
   2  * This program is free software; you can redistribute it and/or modify
   3  * it under the terms of the GNU General Public License, version 2, as
   4  * published by the Free Software Foundation.
   5  *
   6  * This program is distributed in the hope that it will be useful,
   7  * but WITHOUT ANY WARRANTY; without even the implied warranty of
   8  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
   9  * GNU General Public License for more details.
  10  *
  11  * You should have received a copy of the GNU General Public License
  12  * along with this program; if not, write to the Free Software
  13  * Foundation, 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301, USA.
  14  *
  15  * Copyright IBM Corp. 2008
  16  *
  17  * Authors: Hollis Blanchard <hollisb@us.ibm.com>
  18  */
  19
  20 #include <linux/kvm_host.h>
  21 #include <asm/disassemble.h>
  22
  23 #include "booke.h"
  24
  25 #define OP_19_XOP_RFI     50
  26
  27 #define OP_31_XOP_MFMSR   83
  28 #define OP_31_XOP_WRTEE   131
  29 #define OP_31_XOP_MTMSR   146
  30 #define OP_31_XOP_WRTEEI  163
  31
  32 static void kvmppc_emul_rfi(struct kvm_vcpu *vcpu)
  33 {
  34         vcpu->arch.pc = vcpu->arch.srr0;
  35         kvmppc_set_msr(vcpu, vcpu->arch.srr1);
  36 }
  37
  38 int kvmppc_booke_emulate_op(struct kvm_run *run, struct kvm_vcpu *vcpu,
  39                             unsigned int inst, int *advance)
  40 {
  41         int emulated = EMULATE_DONE;
  42         int rs;
  43         int rt;
  44
  45         switch (get_op(inst)) {
  46         case 19:
  47                 switch (get_xop(inst)) {
  48                 case OP_19_XOP_RFI:
  49                         kvmppc_emul_rfi(vcpu);
  50                         kvmppc_set_exit_type(vcpu, EMULATED_RFI_EXITS);
  51                         *advance = 0;
  52                         break;
  53
  54                 default:
  55                         emulated = EMULATE_FAIL;
  56                         break;
  57                 }
  58                 break;
  59
  60         case 31:
  61                 switch (get_xop(inst)) {
  62
  63                 case OP_31_XOP_MFMSR:
  64                         rt = get_rt(inst);
  65                         vcpu->arch.gpr[rt] = vcpu->arch.msr;
  66                         kvmppc_set_exit_type(vcpu, EMULATED_MFMSR_EXITS);
  67                         break;
  68
  69                 case OP_31_XOP_MTMSR:
  70                         rs = get_rs(inst);
  71                         kvmppc_set_exit_type(vcpu, EMULATED_MTMSR_EXITS);
  72                         kvmppc_set_msr(vcpu, vcpu->arch.gpr[rs]);
  73                         break;
  74
  75                 case OP_31_XOP_WRTEE:
  76                         rs = get_rs(inst);
  77                         vcpu->arch.msr = (vcpu->arch.msr & ~MSR_EE)
  78                                                          | (vcpu->arch.gpr[rs] & MSR_EE);
  79                         kvmppc_set_exit_type(vcpu, EMULATED_WRTEE_EXITS);
  80                         break;
  81
  82                 case OP_31_XOP_WRTEEI:
  83                         vcpu->arch.msr = (vcpu->arch.msr & ~MSR_EE)
  84                                                          | (inst & MSR_EE);
  85                         kvmppc_set_exit_type(vcpu, EMULATED_WRTEE_EXITS);
  86                         break;
  87
  88                 default:
  89                         emulated = EMULATE_FAIL;
  90                 }
  91
  92                 break;
  93
  94         default:
  95                 emulated = EMULATE_FAIL;
  96         }
  97
  98         return emulated;
  99 }
 100
 101 int kvmppc_booke_emulate_mtspr(struct kvm_vcpu *vcpu, int sprn, int rs)
 102 {
 103         int emulated = EMULATE_DONE;
 104
 105         switch (sprn) {
 106         case SPRN_DEAR:
 107                 vcpu->arch.dear = vcpu->arch.gpr[rs]; break;
 108         case SPRN_ESR:
 109                 vcpu->arch.esr = vcpu->arch.gpr[rs]; break;
 110         case SPRN_DBCR0:
 111                 vcpu->arch.dbcr0 = vcpu->arch.gpr[rs]; break;
 112         case SPRN_DBCR1:
 113                 vcpu->arch.dbcr1 = vcpu->arch.gpr[rs]; break;
 114         case SPRN_DBSR:
 115                 vcpu->arch.dbsr &= ~vcpu->arch.gpr[rs]; break;
 116         case SPRN_TSR:
 117                 vcpu->arch.tsr &= ~vcpu->arch.gpr[rs]; break;
 118         case SPRN_TCR:
 119                 vcpu->arch.tcr = vcpu->arch.gpr[rs];
 120                 kvmppc_emulate_dec(vcpu);
 121                 break;
 122
 123         /* Note: SPRG4-7 are user-readable. These values are
 124          * loaded into the real SPRGs when resuming the
 125          * guest. */
 126         case SPRN_SPRG4:
 127                 vcpu->arch.sprg4 = vcpu->arch.gpr[rs]; break;
 128         case SPRN_SPRG5:
 129                 vcpu->arch.sprg5 = vcpu->arch.gpr[rs]; break;
 130         case SPRN_SPRG6:
 131                 vcpu->arch.sprg6 = vcpu->arch.gpr[rs]; break;
 132         case SPRN_SPRG7:
 133                 vcpu->arch.sprg7 = vcpu->arch.gpr[rs]; break;
 134
 135         case SPRN_IVPR:
 136                 vcpu->arch.ivpr = vcpu->arch.gpr[rs];
 137                 break;
 138         case SPRN_IVOR0:
 139                 vcpu->arch.ivor[BOOKE_IRQPRIO_CRITICAL] = vcpu->arch.gpr[rs];
 140                 break;
 141         case SPRN_IVOR1:
 142                 vcpu->arch.ivor[BOOKE_IRQPRIO_MACHINE_CHECK] = vcpu->arch.gpr[rs];
 143                 break;
 144         case SPRN_IVOR2:
 145                 vcpu->arch.ivor[BOOKE_IRQPRIO_DATA_STORAGE] = vcpu->arch.gpr[rs];
 146                 break;
 147         case SPRN_IVOR3:
 148                 vcpu->arch.ivor[BOOKE_IRQPRIO_INST_STORAGE] = vcpu->arch.gpr[rs];
 149                 break;
 150         case SPRN_IVOR4:
 151                 vcpu->arch.ivor[BOOKE_IRQPRIO_EXTERNAL] = vcpu->arch.gpr[rs];
 152                 break;
 153         case SPRN_IVOR5:
 154                 vcpu->arch.ivor[BOOKE_IRQPRIO_ALIGNMENT] = vcpu->arch.gpr[rs];
 155                 break;
 156         case SPRN_IVOR6:
 157                 vcpu->arch.ivor[BOOKE_IRQPRIO_PROGRAM] = vcpu->arch.gpr[rs];
 158                 break;
 159         case SPRN_IVOR7:
 160                 vcpu->arch.ivor[BOOKE_IRQPRIO_FP_UNAVAIL] = vcpu->arch.gpr[rs];
 161                 break;
 162         case SPRN_IVOR8:
 163                 vcpu->arch.ivor[BOOKE_IRQPRIO_SYSCALL] = vcpu->arch.gpr[rs];
 164                 break;
 165         case SPRN_IVOR9:
 166                 vcpu->arch.ivor[BOOKE_IRQPRIO_AP_UNAVAIL] = vcpu->arch.gpr[rs];
 167                 break;
 168         case SPRN_IVOR10:
 169                 vcpu->arch.ivor[BOOKE_IRQPRIO_DECREMENTER] = vcpu->arch.gpr[rs];
 170                 break;
 171         case SPRN_IVOR11:
 172                 vcpu->arch.ivor[BOOKE_IRQPRIO_FIT] = vcpu->arch.gpr[rs];
 173                 break;
 174         case SPRN_IVOR12:
 175                 vcpu->arch.ivor[BOOKE_IRQPRIO_WATCHDOG] = vcpu->arch.gpr[rs];
 176                 break;
 177         case SPRN_IVOR13:
 178                 vcpu->arch.ivor[BOOKE_IRQPRIO_DTLB_MISS] = vcpu->arch.gpr[rs];
 179                 break;
 180         case SPRN_IVOR14:
 181                 vcpu->arch.ivor[BOOKE_IRQPRIO_ITLB_MISS] = vcpu->arch.gpr[rs];
 182                 break;
 183         case SPRN_IVOR15:
 184                 vcpu->arch.ivor[BOOKE_IRQPRIO_DEBUG] = vcpu->arch.gpr[rs];
 185                 break;
 186
 187         default:
 188                 emulated = EMULATE_FAIL;
 189         }
 190
 191         return emulated;
 192 }
 193
 194 int kvmppc_booke_emulate_mfspr(struct kvm_vcpu *vcpu, int sprn, int rt)
 195 {
 196         int emulated = EMULATE_DONE;
 197
 198         switch (sprn) {
 199         case SPRN_IVPR:
 200                 vcpu->arch.gpr[rt] = vcpu->arch.ivpr; break;
 201         case SPRN_DEAR:
 202                 vcpu->arch.gpr[rt] = vcpu->arch.dear; break;
 203         case SPRN_ESR:
 204                 vcpu->arch.gpr[rt] = vcpu->arch.esr; break;
 205         case SPRN_DBCR0:
 206                 vcpu->arch.gpr[rt] = vcpu->arch.dbcr0; break;
 207         case SPRN_DBCR1:
 208                 vcpu->arch.gpr[rt] = vcpu->arch.dbcr1; break;
 209         case SPRN_DBSR:
 210                 vcpu->arch.gpr[rt] = vcpu->arch.dbsr; break;
 211
 212         case SPRN_IVOR0:
 213                 vcpu->arch.gpr[rt] = vcpu->arch.ivor[BOOKE_IRQPRIO_CRITICAL];
 214                 break;
 215         case SPRN_IVOR1:
 216                 vcpu->arch.gpr[rt] = vcpu->arch.ivor[BOOKE_IRQPRIO_MACHINE_CHECK];
 217                 break;
 218         case SPRN_IVOR2:
 219                 vcpu->arch.gpr[rt] = vcpu->arch.ivor[BOOKE_IRQPRIO_DATA_STORAGE];
 220                 break;
 221         case SPRN_IVOR3:
 222                 vcpu->arch.gpr[rt] = vcpu->arch.ivor[BOOKE_IRQPRIO_INST_STORAGE];
 223                 break;
 224         case SPRN_IVOR4:
 225                 vcpu->arch.gpr[rt] = vcpu->arch.ivor[BOOKE_IRQPRIO_EXTERNAL];
 226                 break;
 227         case SPRN_IVOR5:
 228                 vcpu->arch.gpr[rt] = vcpu->arch.ivor[BOOKE_IRQPRIO_ALIGNMENT];
 229                 break;
 230         case SPRN_IVOR6:
 231                 vcpu->arch.gpr[rt] = vcpu->arch.ivor[BOOKE_IRQPRIO_PROGRAM];
 232                 break;
 233         case SPRN_IVOR7:
 234                 vcpu->arch.gpr[rt] = vcpu->arch.ivor[BOOKE_IRQPRIO_FP_UNAVAIL];
 235                 break;
 236         case SPRN_IVOR8:
 237                 vcpu->arch.gpr[rt] = vcpu->arch.ivor[BOOKE_IRQPRIO_SYSCALL];
 238                 break;
 239         case SPRN_IVOR9:
 240                 vcpu->arch.gpr[rt] = vcpu->arch.ivor[BOOKE_IRQPRIO_AP_UNAVAIL];
 241                 break;
 242         case SPRN_IVOR10:
 243                 vcpu->arch.gpr[rt] = vcpu->arch.ivor[BOOKE_IRQPRIO_DECREMENTER];
 244                 break;
 245         case SPRN_IVOR11:
 246                 vcpu->arch.gpr[rt] = vcpu->arch.ivor[BOOKE_IRQPRIO_FIT];
 247                 break;
 248         case SPRN_IVOR12:
 249                 vcpu->arch.gpr[rt] = vcpu->arch.ivor[BOOKE_IRQPRIO_WATCHDOG];
 250                 break;
 251         case SPRN_IVOR13:
 252                 vcpu->arch.gpr[rt] = vcpu->arch.ivor[BOOKE_IRQPRIO_DTLB_MISS];
 253                 break;
 254         case SPRN_IVOR14:
 255                 vcpu->arch.gpr[rt] = vcpu->arch.ivor[BOOKE_IRQPRIO_ITLB_MISS];
 256                 break;
 257         case SPRN_IVOR15:
 258                 vcpu->arch.gpr[rt] = vcpu->arch.ivor[BOOKE_IRQPRIO_DEBUG];
 259                 break;
 260
 261         default:
 262                 emulated = EMULATE_FAIL;
 263         }
 264
 265         return emulated;
 266 }