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  * Copyright 2011 Freescale Semiconductor, Inc.
  17  *
  18  * Authors: Hollis Blanchard <hollisb@us.ibm.com>
  19  */
  20
  21 #include <linux/kvm_host.h>
  22 #include <asm/disassemble.h>
  23
  24 #include "booke.h"
  25
  26 #define OP_19_XOP_RFI     50
  27 #define OP_19_XOP_RFCI    51
  28 #define OP_19_XOP_RFDI    39
  29
  30 #define OP_31_XOP_MFMSR   83
  31 #define OP_31_XOP_WRTEE   131
  32 #define OP_31_XOP_MTMSR   146
  33 #define OP_31_XOP_WRTEEI  163
  34
  35 static void kvmppc_emul_rfi(struct kvm_vcpu *vcpu)
  36 {
  37         vcpu->arch.pc = vcpu->arch.shared->srr0;
  38         kvmppc_set_msr(vcpu, vcpu->arch.shared->srr1);
  39 }
  40
  41 static void kvmppc_emul_rfdi(struct kvm_vcpu *vcpu)
  42 {
  43         vcpu->arch.pc = vcpu->arch.dsrr0;
  44         kvmppc_set_msr(vcpu, vcpu->arch.dsrr1);
  45 }
  46
  47 static void kvmppc_emul_rfci(struct kvm_vcpu *vcpu)
  48 {
  49         vcpu->arch.pc = vcpu->arch.csrr0;
  50         kvmppc_set_msr(vcpu, vcpu->arch.csrr1);
  51 }
  52
  53 int kvmppc_booke_emulate_op(struct kvm_run *run, struct kvm_vcpu *vcpu,
  54                             unsigned int inst, int *advance)
  55 {
  56         int emulated = EMULATE_DONE;
  57         int rs = get_rs(inst);
  58         int rt = get_rt(inst);
  59
  60         switch (get_op(inst)) {
  61         case 19:
  62                 switch (get_xop(inst)) {
  63                 case OP_19_XOP_RFI:
  64                         kvmppc_emul_rfi(vcpu);
  65                         kvmppc_set_exit_type(vcpu, EMULATED_RFI_EXITS);
  66                         *advance = 0;
  67                         break;
  68
  69                 case OP_19_XOP_RFCI:
  70                         kvmppc_emul_rfci(vcpu);
  71                         kvmppc_set_exit_type(vcpu, EMULATED_RFCI_EXITS);
  72                         *advance = 0;
  73                         break;
  74
  75                 case OP_19_XOP_RFDI:
  76                         kvmppc_emul_rfdi(vcpu);
  77                         kvmppc_set_exit_type(vcpu, EMULATED_RFDI_EXITS);
  78                         *advance = 0;
  79                         break;
  80
  81                 default:
  82                         emulated = EMULATE_FAIL;
  83                         break;
  84                 }
  85                 break;
  86
  87         case 31:
  88                 switch (get_xop(inst)) {
  89
  90                 case OP_31_XOP_MFMSR:
  91                         kvmppc_set_gpr(vcpu, rt, vcpu->arch.shared->msr);
  92                         kvmppc_set_exit_type(vcpu, EMULATED_MFMSR_EXITS);
  93                         break;
  94
  95                 case OP_31_XOP_MTMSR:
  96                         kvmppc_set_exit_type(vcpu, EMULATED_MTMSR_EXITS);
  97                         kvmppc_set_msr(vcpu, kvmppc_get_gpr(vcpu, rs));
  98                         break;
  99
 100                 case OP_31_XOP_WRTEE:
 101                         vcpu->arch.shared->msr = (vcpu->arch.shared->msr & ~MSR_EE)
 102                                         | (kvmppc_get_gpr(vcpu, rs) & MSR_EE);
 103                         kvmppc_set_exit_type(vcpu, EMULATED_WRTEE_EXITS);
 104                         break;
 105
 106                 case OP_31_XOP_WRTEEI:
 107                         vcpu->arch.shared->msr = (vcpu->arch.shared->msr & ~MSR_EE)
 108                                                          | (inst & MSR_EE);
 109                         kvmppc_set_exit_type(vcpu, EMULATED_WRTEE_EXITS);
 110                         break;
 111
 112                 default:
 113                         emulated = EMULATE_FAIL;
 114                 }
 115
 116                 break;
 117
 118         default:
 119                 emulated = EMULATE_FAIL;
 120         }
 121
 122         return emulated;
 123 }
 124
 125 /*
 126  * NOTE: some of these registers are not emulated on BOOKE_HV (GS-mode).
 127  * Their backing store is in real registers, and these functions
 128  * will return the wrong result if called for them in another context
 129  * (such as debugging).
 130  */
 131 int kvmppc_booke_emulate_mtspr(struct kvm_vcpu *vcpu, int sprn, ulong spr_val)
 132 {
 133         int emulated = EMULATE_DONE;
 134         bool debug_inst = false;
 135
 136         switch (sprn) {
 137         case SPRN_DEAR:
 138                 vcpu->arch.shared->dar = spr_val;
 139                 break;
 140         case SPRN_ESR:
 141                 vcpu->arch.shared->esr = spr_val;
 142                 break;
 143         case SPRN_CSRR0:
 144                 vcpu->arch.csrr0 = spr_val;
 145                 break;
 146         case SPRN_CSRR1:
 147                 vcpu->arch.csrr1 = spr_val;
 148                 break;
 149         case SPRN_DSRR0:
 150                 vcpu->arch.dsrr0 = spr_val;
 151                 break;
 152         case SPRN_DSRR1:
 153                 vcpu->arch.dsrr1 = spr_val;
 154                 break;
 155         case SPRN_IAC1:
 156                 /*
 157                  * If userspace is debugging guest then guest
 158                  * can not access debug registers.
 159                  */
 160                 if (vcpu->guest_debug)
 161                         break;
 162
 163                 debug_inst = true;
 164                 vcpu->arch.dbg_reg.iac1 = spr_val;
 165                 break;
 166         case SPRN_IAC2:
 167                 /*
 168                  * If userspace is debugging guest then guest
 169                  * can not access debug registers.
 170                  */
 171                 if (vcpu->guest_debug)
 172                         break;
 173
 174                 debug_inst = true;
 175                 vcpu->arch.dbg_reg.iac2 = spr_val;
 176                 break;
 177 #if CONFIG_PPC_ADV_DEBUG_IACS > 2
 178         case SPRN_IAC3:
 179                 /*
 180                  * If userspace is debugging guest then guest
 181                  * can not access debug registers.
 182                  */
 183                 if (vcpu->guest_debug)
 184                         break;
 185
 186                 debug_inst = true;
 187                 vcpu->arch.dbg_reg.iac3 = spr_val;
 188                 break;
 189         case SPRN_IAC4:
 190                 /*
 191                  * If userspace is debugging guest then guest
 192                  * can not access debug registers.
 193                  */
 194                 if (vcpu->guest_debug)
 195                         break;
 196
 197                 debug_inst = true;
 198                 vcpu->arch.dbg_reg.iac4 = spr_val;
 199                 break;
 200 #endif
 201         case SPRN_DAC1:
 202                 /*
 203                  * If userspace is debugging guest then guest
 204                  * can not access debug registers.
 205                  */
 206                 if (vcpu->guest_debug)
 207                         break;
 208
 209                 debug_inst = true;
 210                 vcpu->arch.dbg_reg.dac1 = spr_val;
 211                 break;
 212         case SPRN_DAC2:
 213                 /*
 214                  * If userspace is debugging guest then guest
 215                  * can not access debug registers.
 216                  */
 217                 if (vcpu->guest_debug)
 218                         break;
 219
 220                 debug_inst = true;
 221                 vcpu->arch.dbg_reg.dac2 = spr_val;
 222                 break;
 223         case SPRN_DBCR0:
 224                 /*
 225                  * If userspace is debugging guest then guest
 226                  * can not access debug registers.
 227                  */
 228                 if (vcpu->guest_debug)
 229                         break;
 230
 231                 debug_inst = true;
 232                 spr_val &= (DBCR0_IDM | DBCR0_IC | DBCR0_BT | DBCR0_TIE |
 233                         DBCR0_IAC1 | DBCR0_IAC2 | DBCR0_IAC3 | DBCR0_IAC4  |
 234                         DBCR0_DAC1R | DBCR0_DAC1W | DBCR0_DAC2R | DBCR0_DAC2W);
 235
 236                 vcpu->arch.dbg_reg.dbcr0 = spr_val;
 237                 break;
 238         case SPRN_DBCR1:
 239                 /*
 240                  * If userspace is debugging guest then guest
 241                  * can not access debug registers.
 242                  */
 243                 if (vcpu->guest_debug)
 244                         break;
 245
 246                 debug_inst = true;
 247                 vcpu->arch.dbg_reg.dbcr1 = spr_val;
 248                 break;
 249         case SPRN_DBCR2:
 250                 /*
 251                  * If userspace is debugging guest then guest
 252                  * can not access debug registers.
 253                  */
 254                 if (vcpu->guest_debug)
 255                         break;
 256
 257                 debug_inst = true;
 258                 vcpu->arch.dbg_reg.dbcr2 = spr_val;
 259                 break;
 260         case SPRN_DBSR:
 261                 /*
 262                  * If userspace is debugging guest then guest
 263                  * can not access debug registers.
 264                  */
 265                 if (vcpu->guest_debug)
 266                         break;
 267
 268                 vcpu->arch.dbsr &= ~spr_val;
 269                 if (!(vcpu->arch.dbsr & ~DBSR_IDE))
 270                         kvmppc_core_dequeue_debug(vcpu);
 271                 break;
 272         case SPRN_TSR:
 273                 kvmppc_clr_tsr_bits(vcpu, spr_val);
 274                 break;
 275         case SPRN_TCR:
 276                 /*
 277                  * WRC is a 2-bit field that is supposed to preserve its
 278                  * value once written to non-zero.
 279                  */
 280                 if (vcpu->arch.tcr & TCR_WRC_MASK) {
 281                         spr_val &= ~TCR_WRC_MASK;
 282                         spr_val |= vcpu->arch.tcr & TCR_WRC_MASK;
 283                 }
 284                 kvmppc_set_tcr(vcpu, spr_val);
 285                 break;
 286
 287         case SPRN_DECAR:
 288                 vcpu->arch.decar = spr_val;
 289                 break;
 290         /*
 291          * Note: SPRG4-7 are user-readable.
 292          * These values are loaded into the real SPRGs when resuming the
 293          * guest (PR-mode only).
 294          */
 295         case SPRN_SPRG4:
 296                 kvmppc_set_sprg4(vcpu, spr_val);
 297                 break;
 298         case SPRN_SPRG5:
 299                 kvmppc_set_sprg5(vcpu, spr_val);
 300                 break;
 301         case SPRN_SPRG6:
 302                 kvmppc_set_sprg6(vcpu, spr_val);
 303                 break;
 304         case SPRN_SPRG7:
 305                 kvmppc_set_sprg7(vcpu, spr_val);
 306                 break;
 307
 308         case SPRN_IVPR:
 309                 vcpu->arch.ivpr = spr_val;
 310 #ifdef CONFIG_KVM_BOOKE_HV
 311                 mtspr(SPRN_GIVPR, spr_val);
 312 #endif
 313                 break;
 314         case SPRN_IVOR0:
 315                 vcpu->arch.ivor[BOOKE_IRQPRIO_CRITICAL] = spr_val;
 316                 break;
 317         case SPRN_IVOR1:
 318                 vcpu->arch.ivor[BOOKE_IRQPRIO_MACHINE_CHECK] = spr_val;
 319                 break;
 320         case SPRN_IVOR2:
 321                 vcpu->arch.ivor[BOOKE_IRQPRIO_DATA_STORAGE] = spr_val;
 322 #ifdef CONFIG_KVM_BOOKE_HV
 323                 mtspr(SPRN_GIVOR2, spr_val);
 324 #endif
 325                 break;
 326         case SPRN_IVOR3:
 327                 vcpu->arch.ivor[BOOKE_IRQPRIO_INST_STORAGE] = spr_val;
 328                 break;
 329         case SPRN_IVOR4:
 330                 vcpu->arch.ivor[BOOKE_IRQPRIO_EXTERNAL] = spr_val;
 331                 break;
 332         case SPRN_IVOR5:
 333                 vcpu->arch.ivor[BOOKE_IRQPRIO_ALIGNMENT] = spr_val;
 334                 break;
 335         case SPRN_IVOR6:
 336                 vcpu->arch.ivor[BOOKE_IRQPRIO_PROGRAM] = spr_val;
 337                 break;
 338         case SPRN_IVOR7:
 339                 vcpu->arch.ivor[BOOKE_IRQPRIO_FP_UNAVAIL] = spr_val;
 340                 break;
 341         case SPRN_IVOR8:
 342                 vcpu->arch.ivor[BOOKE_IRQPRIO_SYSCALL] = spr_val;
 343 #ifdef CONFIG_KVM_BOOKE_HV
 344                 mtspr(SPRN_GIVOR8, spr_val);
 345 #endif
 346                 break;
 347         case SPRN_IVOR9:
 348                 vcpu->arch.ivor[BOOKE_IRQPRIO_AP_UNAVAIL] = spr_val;
 349                 break;
 350         case SPRN_IVOR10:
 351                 vcpu->arch.ivor[BOOKE_IRQPRIO_DECREMENTER] = spr_val;
 352                 break;
 353         case SPRN_IVOR11:
 354                 vcpu->arch.ivor[BOOKE_IRQPRIO_FIT] = spr_val;
 355                 break;
 356         case SPRN_IVOR12:
 357                 vcpu->arch.ivor[BOOKE_IRQPRIO_WATCHDOG] = spr_val;
 358                 break;
 359         case SPRN_IVOR13:
 360                 vcpu->arch.ivor[BOOKE_IRQPRIO_DTLB_MISS] = spr_val;
 361                 break;
 362         case SPRN_IVOR14:
 363                 vcpu->arch.ivor[BOOKE_IRQPRIO_ITLB_MISS] = spr_val;
 364                 break;
 365         case SPRN_IVOR15:
 366                 vcpu->arch.ivor[BOOKE_IRQPRIO_DEBUG] = spr_val;
 367                 break;
 368         case SPRN_MCSR:
 369                 vcpu->arch.mcsr &= ~spr_val;
 370                 break;
 371 #if defined(CONFIG_64BIT)
 372         case SPRN_EPCR:
 373                 kvmppc_set_epcr(vcpu, spr_val);
 374 #ifdef CONFIG_KVM_BOOKE_HV
 375                 mtspr(SPRN_EPCR, vcpu->arch.shadow_epcr);
 376 #endif
 377                 break;
 378 #endif
 379         default:
 380                 emulated = EMULATE_FAIL;
 381         }
 382
 383         if (debug_inst) {
 384                 current->thread.debug = vcpu->arch.dbg_reg;
 385                 switch_booke_debug_regs(&vcpu->arch.dbg_reg);
 386         }
 387         return emulated;
 388 }
 389
 390 int kvmppc_booke_emulate_mfspr(struct kvm_vcpu *vcpu, int sprn, ulong *spr_val)
 391 {
 392         int emulated = EMULATE_DONE;
 393
 394         switch (sprn) {
 395         case SPRN_IVPR:
 396                 *spr_val = vcpu->arch.ivpr;
 397                 break;
 398         case SPRN_DEAR:
 399                 *spr_val = vcpu->arch.shared->dar;
 400                 break;
 401         case SPRN_ESR:
 402                 *spr_val = vcpu->arch.shared->esr;
 403                 break;
 404         case SPRN_EPR:
 405                 *spr_val = vcpu->arch.epr;
 406                 break;
 407         case SPRN_CSRR0:
 408                 *spr_val = vcpu->arch.csrr0;
 409                 break;
 410         case SPRN_CSRR1:
 411                 *spr_val = vcpu->arch.csrr1;
 412                 break;
 413         case SPRN_DSRR0:
 414                 *spr_val = vcpu->arch.dsrr0;
 415                 break;
 416         case SPRN_DSRR1:
 417                 *spr_val = vcpu->arch.dsrr1;
 418                 break;
 419         case SPRN_IAC1:
 420                 *spr_val = vcpu->arch.dbg_reg.iac1;
 421                 break;
 422         case SPRN_IAC2:
 423                 *spr_val = vcpu->arch.dbg_reg.iac2;
 424                 break;
 425 #if CONFIG_PPC_ADV_DEBUG_IACS > 2
 426         case SPRN_IAC3:
 427                 *spr_val = vcpu->arch.dbg_reg.iac3;
 428                 break;
 429         case SPRN_IAC4:
 430                 *spr_val = vcpu->arch.dbg_reg.iac4;
 431                 break;
 432 #endif
 433         case SPRN_DAC1:
 434                 *spr_val = vcpu->arch.dbg_reg.dac1;
 435                 break;
 436         case SPRN_DAC2:
 437                 *spr_val = vcpu->arch.dbg_reg.dac2;
 438                 break;
 439         case SPRN_DBCR0:
 440                 *spr_val = vcpu->arch.dbg_reg.dbcr0;
 441                 if (vcpu->guest_debug)
 442                         *spr_val = *spr_val | DBCR0_EDM;
 443                 break;
 444         case SPRN_DBCR1:
 445                 *spr_val = vcpu->arch.dbg_reg.dbcr1;
 446                 break;
 447         case SPRN_DBCR2:
 448                 *spr_val = vcpu->arch.dbg_reg.dbcr2;
 449                 break;
 450         case SPRN_DBSR:
 451                 *spr_val = vcpu->arch.dbsr;
 452                 break;
 453         case SPRN_TSR:
 454                 *spr_val = vcpu->arch.tsr;
 455                 break;
 456         case SPRN_TCR:
 457                 *spr_val = vcpu->arch.tcr;
 458                 break;
 459
 460         case SPRN_IVOR0:
 461                 *spr_val = vcpu->arch.ivor[BOOKE_IRQPRIO_CRITICAL];
 462                 break;
 463         case SPRN_IVOR1:
 464                 *spr_val = vcpu->arch.ivor[BOOKE_IRQPRIO_MACHINE_CHECK];
 465                 break;
 466         case SPRN_IVOR2:
 467                 *spr_val = vcpu->arch.ivor[BOOKE_IRQPRIO_DATA_STORAGE];
 468                 break;
 469         case SPRN_IVOR3:
 470                 *spr_val = vcpu->arch.ivor[BOOKE_IRQPRIO_INST_STORAGE];
 471                 break;
 472         case SPRN_IVOR4:
 473                 *spr_val = vcpu->arch.ivor[BOOKE_IRQPRIO_EXTERNAL];
 474                 break;
 475         case SPRN_IVOR5:
 476                 *spr_val = vcpu->arch.ivor[BOOKE_IRQPRIO_ALIGNMENT];
 477                 break;
 478         case SPRN_IVOR6:
 479                 *spr_val = vcpu->arch.ivor[BOOKE_IRQPRIO_PROGRAM];
 480                 break;
 481         case SPRN_IVOR7:
 482                 *spr_val = vcpu->arch.ivor[BOOKE_IRQPRIO_FP_UNAVAIL];
 483                 break;
 484         case SPRN_IVOR8:
 485                 *spr_val = vcpu->arch.ivor[BOOKE_IRQPRIO_SYSCALL];
 486                 break;
 487         case SPRN_IVOR9:
 488                 *spr_val = vcpu->arch.ivor[BOOKE_IRQPRIO_AP_UNAVAIL];
 489                 break;
 490         case SPRN_IVOR10:
 491                 *spr_val = vcpu->arch.ivor[BOOKE_IRQPRIO_DECREMENTER];
 492                 break;
 493         case SPRN_IVOR11:
 494                 *spr_val = vcpu->arch.ivor[BOOKE_IRQPRIO_FIT];
 495                 break;
 496         case SPRN_IVOR12:
 497                 *spr_val = vcpu->arch.ivor[BOOKE_IRQPRIO_WATCHDOG];
 498                 break;
 499         case SPRN_IVOR13:
 500                 *spr_val = vcpu->arch.ivor[BOOKE_IRQPRIO_DTLB_MISS];
 501                 break;
 502         case SPRN_IVOR14:
 503                 *spr_val = vcpu->arch.ivor[BOOKE_IRQPRIO_ITLB_MISS];
 504                 break;
 505         case SPRN_IVOR15:
 506                 *spr_val = vcpu->arch.ivor[BOOKE_IRQPRIO_DEBUG];
 507                 break;
 508         case SPRN_MCSR:
 509                 *spr_val = vcpu->arch.mcsr;
 510                 break;
 511 #if defined(CONFIG_64BIT)
 512         case SPRN_EPCR:
 513                 *spr_val = vcpu->arch.epcr;
 514                 break;
 515 #endif
 516
 517         default:
 518                 emulated = EMULATE_FAIL;
 519         }
 520
 521         return emulated;
 522 }