arch/powerpc/kvm/emulate_loadstore.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. 2007
  16  * Copyright 2011 Freescale Semiconductor, Inc.
  17  *
  18  * Authors: Hollis Blanchard <[email protected]>
  19  */
  20
  21 #include <linux/jiffies.h>
  22 #include <linux/hrtimer.h>
  23 #include <linux/types.h>
  24 #include <linux/string.h>
  25 #include <linux/kvm_host.h>
  26 #include <linux/clockchips.h>
  27
  28 #include <asm/reg.h>
  29 #include <asm/time.h>
  30 #include <asm/byteorder.h>
  31 #include <asm/kvm_ppc.h>
  32 #include <asm/disassemble.h>
  33 #include <asm/ppc-opcode.h>
  34 #include "timing.h"
  35 #include "trace.h"
  36
  37 /* XXX to do:
  38  * lhax
  39  * lhaux
  40  * lswx
  41  * lswi
  42  * stswx
  43  * stswi
  44  * lha
  45  * lhau
  46  * lmw
  47  * stmw
  48  *
  49  */
  50 int kvmppc_emulate_loadstore(struct kvm_vcpu *vcpu)
  51 {
  52         struct kvm_run *run = vcpu->run;
  53         u32 inst;
  54         int ra, rs, rt;
  55         enum emulation_result emulated;
  56         int advance = 1;
  57
  58         /* this default type might be overwritten by subcategories */
  59         kvmppc_set_exit_type(vcpu, EMULATED_INST_EXITS);
  60
  61         emulated = kvmppc_get_last_inst(vcpu, INST_GENERIC, &inst);
  62         if (emulated != EMULATE_DONE)
  63                 return emulated;
  64
  65         ra = get_ra(inst);
  66         rs = get_rs(inst);
  67         rt = get_rt(inst);
  68
  69         switch (get_op(inst)) {
  70         case 31:
  71                 switch (get_xop(inst)) {
  72                 case OP_31_XOP_LWZX:
  73                         emulated = kvmppc_handle_load(run, vcpu, rt, 4, 1);
  74                         break;
  75
  76                 case OP_31_XOP_LBZX:
  77                         emulated = kvmppc_handle_load(run, vcpu, rt, 1, 1);
  78                         break;
  79
  80                 case OP_31_XOP_LBZUX:
  81                         emulated = kvmppc_handle_load(run, vcpu, rt, 1, 1);
  82                         kvmppc_set_gpr(vcpu, ra, vcpu->arch.vaddr_accessed);
  83                         break;
  84
  85                 case OP_31_XOP_STWX:
  86                         emulated = kvmppc_handle_store(run, vcpu,
  87                                                        kvmppc_get_gpr(vcpu, rs),
  88                                                        4, 1);
  89                         break;
  90
  91                 case OP_31_XOP_STBX:
  92                         emulated = kvmppc_handle_store(run, vcpu,
  93                                                        kvmppc_get_gpr(vcpu, rs),
  94                                                        1, 1);
  95                         break;
  96
  97                 case OP_31_XOP_STBUX:
  98                         emulated = kvmppc_handle_store(run, vcpu,
  99                                                        kvmppc_get_gpr(vcpu, rs),
 100                                                        1, 1);
 101                         kvmppc_set_gpr(vcpu, ra, vcpu->arch.vaddr_accessed);
 102                         break;
 103
 104                 case OP_31_XOP_LHAX:
 105                         emulated = kvmppc_handle_loads(run, vcpu, rt, 2, 1);
 106                         break;
 107
 108                 case OP_31_XOP_LHZX:
 109                         emulated = kvmppc_handle_load(run, vcpu, rt, 2, 1);
 110                         break;
 111
 112                 case OP_31_XOP_LHZUX:
 113                         emulated = kvmppc_handle_load(run, vcpu, rt, 2, 1);
 114                         kvmppc_set_gpr(vcpu, ra, vcpu->arch.vaddr_accessed);
 115                         break;
 116
 117                 case OP_31_XOP_STHX:
 118                         emulated = kvmppc_handle_store(run, vcpu,
 119                                                        kvmppc_get_gpr(vcpu, rs),
 120                                                        2, 1);
 121                         break;
 122
 123                 case OP_31_XOP_STHUX:
 124                         emulated = kvmppc_handle_store(run, vcpu,
 125                                                        kvmppc_get_gpr(vcpu, rs),
 126                                                        2, 1);
 127                         kvmppc_set_gpr(vcpu, ra, vcpu->arch.vaddr_accessed);
 128                         break;
 129
 130                 case OP_31_XOP_DCBST:
 131                 case OP_31_XOP_DCBF:
 132                 case OP_31_XOP_DCBI:
 133                         /* Do nothing. The guest is performing dcbi because
 134                          * hardware DMA is not snooped by the dcache, but
 135                          * emulated DMA either goes through the dcache as
 136                          * normal writes, or the host kernel has handled dcache
 137                          * coherence. */
 138                         break;
 139
 140                 case OP_31_XOP_LWBRX:
 141                         emulated = kvmppc_handle_load(run, vcpu, rt, 4, 0);
 142                         break;
 143
 144                 case OP_31_XOP_STWBRX:
 145                         emulated = kvmppc_handle_store(run, vcpu,
 146                                                        kvmppc_get_gpr(vcpu, rs),
 147                                                        4, 0);
 148                         break;
 149
 150                 case OP_31_XOP_LHBRX:
 151                         emulated = kvmppc_handle_load(run, vcpu, rt, 2, 0);
 152                         break;
 153
 154                 case OP_31_XOP_STHBRX:
 155                         emulated = kvmppc_handle_store(run, vcpu,
 156                                                        kvmppc_get_gpr(vcpu, rs),
 157                                                        2, 0);
 158                         break;
 159
 160                 default:
 161                         emulated = EMULATE_FAIL;
 162                         break;
 163                 }
 164                 break;
 165
 166         case OP_LWZ:
 167                 emulated = kvmppc_handle_load(run, vcpu, rt, 4, 1);
 168                 break;
 169
 170         /* TBD: Add support for other 64 bit load variants like ldu, ldux, ldx etc. */
 171         case OP_LD:
 172                 rt = get_rt(inst);
 173                 emulated = kvmppc_handle_load(run, vcpu, rt, 8, 1);
 174                 break;
 175
 176         case OP_LWZU:
 177                 emulated = kvmppc_handle_load(run, vcpu, rt, 4, 1);
 178                 kvmppc_set_gpr(vcpu, ra, vcpu->arch.vaddr_accessed);
 179                 break;
 180
 181         case OP_LBZ:
 182                 emulated = kvmppc_handle_load(run, vcpu, rt, 1, 1);
 183                 break;
 184
 185         case OP_LBZU:
 186                 emulated = kvmppc_handle_load(run, vcpu, rt, 1, 1);
 187                 kvmppc_set_gpr(vcpu, ra, vcpu->arch.vaddr_accessed);
 188                 break;
 189
 190         case OP_STW:
 191                 emulated = kvmppc_handle_store(run, vcpu,
 192                                                kvmppc_get_gpr(vcpu, rs),
 193                                                4, 1);
 194                 break;
 195
 196         /* TBD: Add support for other 64 bit store variants like stdu, stdux, stdx etc. */
 197         case OP_STD:
 198                 rs = get_rs(inst);
 199                 emulated = kvmppc_handle_store(run, vcpu,
 200                                                kvmppc_get_gpr(vcpu, rs),
 201                                                8, 1);
 202                 break;
 203
 204         case OP_STWU:
 205                 emulated = kvmppc_handle_store(run, vcpu,
 206                                                kvmppc_get_gpr(vcpu, rs),
 207                                                4, 1);
 208                 kvmppc_set_gpr(vcpu, ra, vcpu->arch.vaddr_accessed);
 209                 break;
 210
 211         case OP_STB:
 212                 emulated = kvmppc_handle_store(run, vcpu,
 213                                                kvmppc_get_gpr(vcpu, rs),
 214                                                1, 1);
 215                 break;
 216
 217         case OP_STBU:
 218                 emulated = kvmppc_handle_store(run, vcpu,
 219                                                kvmppc_get_gpr(vcpu, rs),
 220                                                1, 1);
 221                 kvmppc_set_gpr(vcpu, ra, vcpu->arch.vaddr_accessed);
 222                 break;
 223
 224         case OP_LHZ:
 225                 emulated = kvmppc_handle_load(run, vcpu, rt, 2, 1);
 226                 break;
 227
 228         case OP_LHZU:
 229                 emulated = kvmppc_handle_load(run, vcpu, rt, 2, 1);
 230                 kvmppc_set_gpr(vcpu, ra, vcpu->arch.vaddr_accessed);
 231                 break;
 232
 233         case OP_LHA:
 234                 emulated = kvmppc_handle_loads(run, vcpu, rt, 2, 1);
 235                 break;
 236
 237         case OP_LHAU:
 238                 emulated = kvmppc_handle_loads(run, vcpu, rt, 2, 1);
 239                 kvmppc_set_gpr(vcpu, ra, vcpu->arch.vaddr_accessed);
 240                 break;
 241
 242         case OP_STH:
 243                 emulated = kvmppc_handle_store(run, vcpu,
 244                                                kvmppc_get_gpr(vcpu, rs),
 245                                                2, 1);
 246                 break;
 247
 248         case OP_STHU:
 249                 emulated = kvmppc_handle_store(run, vcpu,
 250                                                kvmppc_get_gpr(vcpu, rs),
 251                                                2, 1);
 252                 kvmppc_set_gpr(vcpu, ra, vcpu->arch.vaddr_accessed);
 253                 break;
 254
 255         default:
 256                 emulated = EMULATE_FAIL;
 257                 break;
 258         }
 259
 260         if (emulated == EMULATE_FAIL) {
 261                 advance = 0;
 262                 kvmppc_core_queue_program(vcpu, 0);
 263         }
 264
 265         trace_kvm_ppc_instr(inst, kvmppc_get_pc(vcpu), emulated);
 266
 267         /* Advance past emulated instruction. */
 268         if (advance)
 269                 kvmppc_set_pc(vcpu, kvmppc_get_pc(vcpu) + 4);
 270
 271         return emulated;
 272 }