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 <hollisb@us.ibm.com> 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, false, &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 } 273