Merge tag 'for-linus-v3.8-rc4' of git://oss.sgi.com/xfs/xfs
[GitHub/mt8127/android_kernel_alcatel_ttab.git] / arch / powerpc / kvm / emulate.c
CommitLineData
bbf45ba5
HB
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
dfd4d47e 16 * Copyright 2011 Freescale Semiconductor, Inc.
bbf45ba5
HB
17 *
18 * Authors: Hollis Blanchard <hollisb@us.ibm.com>
19 */
20
21#include <linux/jiffies.h>
544c6761 22#include <linux/hrtimer.h>
bbf45ba5
HB
23#include <linux/types.h>
24#include <linux/string.h>
25#include <linux/kvm_host.h>
6e35994d 26#include <linux/clockchips.h>
bbf45ba5 27
75f74f0d 28#include <asm/reg.h>
bbf45ba5
HB
29#include <asm/time.h>
30#include <asm/byteorder.h>
31#include <asm/kvm_ppc.h>
c381a043 32#include <asm/disassemble.h>
73e75b41 33#include "timing.h"
46f43c6e 34#include "trace.h"
bbf45ba5 35
cea5d8c9 36#define OP_TRAP 3
513579e3 37#define OP_TRAP_64 2
cea5d8c9 38
6df79df5 39#define OP_31_XOP_TRAP 4
cea5d8c9 40#define OP_31_XOP_LWZX 23
6df79df5 41#define OP_31_XOP_TRAP_64 68
cea5d8c9
HB
42#define OP_31_XOP_LBZX 87
43#define OP_31_XOP_STWX 151
44#define OP_31_XOP_STBX 215
1c85e733 45#define OP_31_XOP_LBZUX 119
cea5d8c9
HB
46#define OP_31_XOP_STBUX 247
47#define OP_31_XOP_LHZX 279
48#define OP_31_XOP_LHZUX 311
49#define OP_31_XOP_MFSPR 339
1c85e733 50#define OP_31_XOP_LHAX 343
cea5d8c9
HB
51#define OP_31_XOP_STHX 407
52#define OP_31_XOP_STHUX 439
53#define OP_31_XOP_MTSPR 467
54#define OP_31_XOP_DCBI 470
55#define OP_31_XOP_LWBRX 534
56#define OP_31_XOP_TLBSYNC 566
57#define OP_31_XOP_STWBRX 662
58#define OP_31_XOP_LHBRX 790
59#define OP_31_XOP_STHBRX 918
60
61#define OP_LWZ 32
6c5cb739 62#define OP_LD 58
cea5d8c9
HB
63#define OP_LWZU 33
64#define OP_LBZ 34
65#define OP_LBZU 35
66#define OP_STW 36
67#define OP_STWU 37
6c5cb739 68#define OP_STD 62
cea5d8c9
HB
69#define OP_STB 38
70#define OP_STBU 39
71#define OP_LHZ 40
72#define OP_LHZU 41
3587d534
AG
73#define OP_LHA 42
74#define OP_LHAU 43
cea5d8c9
HB
75#define OP_STH 44
76#define OP_STHU 45
77
75f74f0d 78void kvmppc_emulate_dec(struct kvm_vcpu *vcpu)
bbf45ba5 79{
544c6761 80 unsigned long dec_nsec;
dc2babfe 81 unsigned long long dec_time;
9a7a9b09 82
544c6761 83 pr_debug("mtDEC: %x\n", vcpu->arch.dec);
dfd4d47e
SW
84 hrtimer_try_to_cancel(&vcpu->arch.dec_timer);
85
00c3a37c 86#ifdef CONFIG_PPC_BOOK3S
7706664d
AG
87 /* mtdec lowers the interrupt line when positive. */
88 kvmppc_core_dequeue_dec(vcpu);
89
513579e3
AG
90 /* POWER4+ triggers a dec interrupt if the value is < 0 */
91 if (vcpu->arch.dec & 0x80000000) {
513579e3
AG
92 kvmppc_core_queue_dec(vcpu);
93 return;
94 }
95#endif
dfd4d47e
SW
96
97#ifdef CONFIG_BOOKE
98 /* On BOOKE, DEC = 0 is as good as decrementer not enabled */
99 if (vcpu->arch.dec == 0)
100 return;
101#endif
102
103 /*
104 * The decrementer ticks at the same rate as the timebase, so
105 * that's how we convert the guest DEC value to the number of
106 * host ticks.
107 */
108
109 dec_time = vcpu->arch.dec;
6e35994d
BB
110 /*
111 * Guest timebase ticks at the same frequency as host decrementer.
112 * So use the host decrementer calculations for decrementer emulation.
113 */
114 dec_time = dec_time << decrementer_clockevent.shift;
115 do_div(dec_time, decrementer_clockevent.mult);
dfd4d47e
SW
116 dec_nsec = do_div(dec_time, NSEC_PER_SEC);
117 hrtimer_start(&vcpu->arch.dec_timer,
118 ktime_set(dec_time, dec_nsec), HRTIMER_MODE_REL);
119 vcpu->arch.dec_jiffies = get_tb();
bbf45ba5
HB
120}
121
5ce941ee
SW
122u32 kvmppc_get_dec(struct kvm_vcpu *vcpu, u64 tb)
123{
124 u64 jd = tb - vcpu->arch.dec_jiffies;
dfd4d47e
SW
125
126#ifdef CONFIG_BOOKE
127 if (vcpu->arch.dec < jd)
128 return 0;
129#endif
130
5ce941ee
SW
131 return vcpu->arch.dec - jd;
132}
133
388cf9ee
AG
134static int kvmppc_emulate_mtspr(struct kvm_vcpu *vcpu, int sprn, int rs)
135{
136 enum emulation_result emulated = EMULATE_DONE;
137 ulong spr_val = kvmppc_get_gpr(vcpu, rs);
138
139 switch (sprn) {
140 case SPRN_SRR0:
141 vcpu->arch.shared->srr0 = spr_val;
142 break;
143 case SPRN_SRR1:
144 vcpu->arch.shared->srr1 = spr_val;
145 break;
146
147 /* XXX We need to context-switch the timebase for
148 * watchdog and FIT. */
149 case SPRN_TBWL: break;
150 case SPRN_TBWU: break;
151
152 case SPRN_MSSSR0: break;
153
154 case SPRN_DEC:
155 vcpu->arch.dec = spr_val;
156 kvmppc_emulate_dec(vcpu);
157 break;
158
159 case SPRN_SPRG0:
160 vcpu->arch.shared->sprg0 = spr_val;
161 break;
162 case SPRN_SPRG1:
163 vcpu->arch.shared->sprg1 = spr_val;
164 break;
165 case SPRN_SPRG2:
166 vcpu->arch.shared->sprg2 = spr_val;
167 break;
168 case SPRN_SPRG3:
169 vcpu->arch.shared->sprg3 = spr_val;
170 break;
171
172 default:
173 emulated = kvmppc_core_emulate_mtspr(vcpu, sprn,
174 spr_val);
175 if (emulated == EMULATE_FAIL)
176 printk(KERN_INFO "mtspr: unknown spr "
177 "0x%x\n", sprn);
178 break;
179 }
180
181 kvmppc_set_exit_type(vcpu, EMULATED_MTSPR_EXITS);
182
183 return emulated;
184}
185
186static int kvmppc_emulate_mfspr(struct kvm_vcpu *vcpu, int sprn, int rt)
187{
188 enum emulation_result emulated = EMULATE_DONE;
189 ulong spr_val = 0;
190
191 switch (sprn) {
192 case SPRN_SRR0:
193 spr_val = vcpu->arch.shared->srr0;
194 break;
195 case SPRN_SRR1:
196 spr_val = vcpu->arch.shared->srr1;
197 break;
198 case SPRN_PVR:
199 spr_val = vcpu->arch.pvr;
200 break;
201 case SPRN_PIR:
202 spr_val = vcpu->vcpu_id;
203 break;
204 case SPRN_MSSSR0:
205 spr_val = 0;
206 break;
207
208 /* Note: mftb and TBRL/TBWL are user-accessible, so
209 * the guest can always access the real TB anyways.
210 * In fact, we probably will never see these traps. */
211 case SPRN_TBWL:
212 spr_val = get_tb() >> 32;
213 break;
214 case SPRN_TBWU:
215 spr_val = get_tb();
216 break;
217
218 case SPRN_SPRG0:
219 spr_val = vcpu->arch.shared->sprg0;
220 break;
221 case SPRN_SPRG1:
222 spr_val = vcpu->arch.shared->sprg1;
223 break;
224 case SPRN_SPRG2:
225 spr_val = vcpu->arch.shared->sprg2;
226 break;
227 case SPRN_SPRG3:
228 spr_val = vcpu->arch.shared->sprg3;
229 break;
230 /* Note: SPRG4-7 are user-readable, so we don't get
231 * a trap. */
232
233 case SPRN_DEC:
234 spr_val = kvmppc_get_dec(vcpu, get_tb());
235 break;
236 default:
237 emulated = kvmppc_core_emulate_mfspr(vcpu, sprn,
238 &spr_val);
239 if (unlikely(emulated == EMULATE_FAIL)) {
240 printk(KERN_INFO "mfspr: unknown spr "
241 "0x%x\n", sprn);
242 }
243 break;
244 }
245
246 if (emulated == EMULATE_DONE)
247 kvmppc_set_gpr(vcpu, rt, spr_val);
248 kvmppc_set_exit_type(vcpu, EMULATED_MFSPR_EXITS);
249
250 return emulated;
251}
252
bbf45ba5
HB
253/* XXX to do:
254 * lhax
255 * lhaux
256 * lswx
257 * lswi
258 * stswx
259 * stswi
260 * lha
261 * lhau
262 * lmw
263 * stmw
264 *
265 * XXX is_bigendian should depend on MMU mapping or MSR[LE]
266 */
75f74f0d
HB
267/* XXX Should probably auto-generate instruction decoding for a particular core
268 * from opcode tables in the future. */
bbf45ba5
HB
269int kvmppc_emulate_instruction(struct kvm_run *run, struct kvm_vcpu *vcpu)
270{
c7f38f46 271 u32 inst = kvmppc_get_last_inst(vcpu);
c46dc9a8
AG
272 int ra = get_ra(inst);
273 int rs = get_rs(inst);
274 int rt = get_rt(inst);
275 int sprn = get_sprn(inst);
bbf45ba5
HB
276 enum emulation_result emulated = EMULATE_DONE;
277 int advance = 1;
278
73e75b41
HB
279 /* this default type might be overwritten by subcategories */
280 kvmppc_set_exit_type(vcpu, EMULATED_INST_EXITS);
281
689fd14a 282 pr_debug("Emulating opcode %d / %d\n", get_op(inst), get_xop(inst));
513579e3 283
bbf45ba5 284 switch (get_op(inst)) {
cea5d8c9 285 case OP_TRAP:
00c3a37c 286#ifdef CONFIG_PPC_BOOK3S
513579e3 287 case OP_TRAP_64:
daf5e271 288 kvmppc_core_queue_program(vcpu, SRR1_PROGTRAP);
513579e3 289#else
b5904972
SW
290 kvmppc_core_queue_program(vcpu,
291 vcpu->arch.shared->esr | ESR_PTR);
513579e3 292#endif
bbf45ba5
HB
293 advance = 0;
294 break;
295
bbf45ba5
HB
296 case 31:
297 switch (get_xop(inst)) {
298
6df79df5
AG
299 case OP_31_XOP_TRAP:
300#ifdef CONFIG_64BIT
301 case OP_31_XOP_TRAP_64:
302#endif
303#ifdef CONFIG_PPC_BOOK3S
304 kvmppc_core_queue_program(vcpu, SRR1_PROGTRAP);
305#else
306 kvmppc_core_queue_program(vcpu,
307 vcpu->arch.shared->esr | ESR_PTR);
308#endif
309 advance = 0;
310 break;
cea5d8c9 311 case OP_31_XOP_LWZX:
ac3cd34e
HB
312 emulated = kvmppc_handle_load(run, vcpu, rt, 4, 1);
313 break;
314
cea5d8c9 315 case OP_31_XOP_LBZX:
bbf45ba5
HB
316 emulated = kvmppc_handle_load(run, vcpu, rt, 1, 1);
317 break;
318
1c85e733 319 case OP_31_XOP_LBZUX:
1c85e733 320 emulated = kvmppc_handle_load(run, vcpu, rt, 1, 1);
6020c0f6 321 kvmppc_set_gpr(vcpu, ra, vcpu->arch.vaddr_accessed);
1c85e733
AG
322 break;
323
cea5d8c9 324 case OP_31_XOP_STWX:
ac3cd34e 325 emulated = kvmppc_handle_store(run, vcpu,
8e5b26b5 326 kvmppc_get_gpr(vcpu, rs),
ac3cd34e
HB
327 4, 1);
328 break;
329
cea5d8c9 330 case OP_31_XOP_STBX:
bbf45ba5 331 emulated = kvmppc_handle_store(run, vcpu,
8e5b26b5 332 kvmppc_get_gpr(vcpu, rs),
bbf45ba5
HB
333 1, 1);
334 break;
335
cea5d8c9 336 case OP_31_XOP_STBUX:
bbf45ba5 337 emulated = kvmppc_handle_store(run, vcpu,
8e5b26b5 338 kvmppc_get_gpr(vcpu, rs),
bbf45ba5 339 1, 1);
978b4fae 340 kvmppc_set_gpr(vcpu, ra, vcpu->arch.vaddr_accessed);
bbf45ba5
HB
341 break;
342
1c85e733 343 case OP_31_XOP_LHAX:
1c85e733
AG
344 emulated = kvmppc_handle_loads(run, vcpu, rt, 2, 1);
345 break;
346
cea5d8c9 347 case OP_31_XOP_LHZX:
bbf45ba5
HB
348 emulated = kvmppc_handle_load(run, vcpu, rt, 2, 1);
349 break;
350
cea5d8c9 351 case OP_31_XOP_LHZUX:
bbf45ba5 352 emulated = kvmppc_handle_load(run, vcpu, rt, 2, 1);
6020c0f6 353 kvmppc_set_gpr(vcpu, ra, vcpu->arch.vaddr_accessed);
bbf45ba5
HB
354 break;
355
cea5d8c9 356 case OP_31_XOP_MFSPR:
388cf9ee 357 emulated = kvmppc_emulate_mfspr(vcpu, sprn, rt);
bbf45ba5
HB
358 break;
359
cea5d8c9 360 case OP_31_XOP_STHX:
bbf45ba5 361 emulated = kvmppc_handle_store(run, vcpu,
8e5b26b5 362 kvmppc_get_gpr(vcpu, rs),
bbf45ba5
HB
363 2, 1);
364 break;
365
cea5d8c9 366 case OP_31_XOP_STHUX:
bbf45ba5 367 emulated = kvmppc_handle_store(run, vcpu,
8e5b26b5 368 kvmppc_get_gpr(vcpu, rs),
bbf45ba5 369 2, 1);
6020c0f6 370 kvmppc_set_gpr(vcpu, ra, vcpu->arch.vaddr_accessed);
bbf45ba5
HB
371 break;
372
cea5d8c9 373 case OP_31_XOP_MTSPR:
388cf9ee 374 emulated = kvmppc_emulate_mtspr(vcpu, sprn, rs);
bbf45ba5
HB
375 break;
376
cea5d8c9 377 case OP_31_XOP_DCBI:
bbf45ba5
HB
378 /* Do nothing. The guest is performing dcbi because
379 * hardware DMA is not snooped by the dcache, but
380 * emulated DMA either goes through the dcache as
381 * normal writes, or the host kernel has handled dcache
382 * coherence. */
383 break;
384
cea5d8c9 385 case OP_31_XOP_LWBRX:
bbf45ba5
HB
386 emulated = kvmppc_handle_load(run, vcpu, rt, 4, 0);
387 break;
388
cea5d8c9 389 case OP_31_XOP_TLBSYNC:
bbf45ba5
HB
390 break;
391
cea5d8c9 392 case OP_31_XOP_STWBRX:
bbf45ba5 393 emulated = kvmppc_handle_store(run, vcpu,
8e5b26b5 394 kvmppc_get_gpr(vcpu, rs),
bbf45ba5
HB
395 4, 0);
396 break;
397
cea5d8c9 398 case OP_31_XOP_LHBRX:
bbf45ba5
HB
399 emulated = kvmppc_handle_load(run, vcpu, rt, 2, 0);
400 break;
401
cea5d8c9 402 case OP_31_XOP_STHBRX:
bbf45ba5 403 emulated = kvmppc_handle_store(run, vcpu,
8e5b26b5 404 kvmppc_get_gpr(vcpu, rs),
bbf45ba5
HB
405 2, 0);
406 break;
407
bbf45ba5 408 default:
75f74f0d 409 /* Attempt core-specific emulation below. */
bbf45ba5 410 emulated = EMULATE_FAIL;
bbf45ba5
HB
411 }
412 break;
413
cea5d8c9 414 case OP_LWZ:
bbf45ba5
HB
415 emulated = kvmppc_handle_load(run, vcpu, rt, 4, 1);
416 break;
417
6c5cb739
VS
418 /* TBD: Add support for other 64 bit load variants like ldu, ldux, ldx etc. */
419 case OP_LD:
420 rt = get_rt(inst);
421 emulated = kvmppc_handle_load(run, vcpu, rt, 8, 1);
422 break;
423
cea5d8c9 424 case OP_LWZU:
bbf45ba5 425 emulated = kvmppc_handle_load(run, vcpu, rt, 4, 1);
6020c0f6 426 kvmppc_set_gpr(vcpu, ra, vcpu->arch.vaddr_accessed);
bbf45ba5
HB
427 break;
428
cea5d8c9 429 case OP_LBZ:
bbf45ba5
HB
430 emulated = kvmppc_handle_load(run, vcpu, rt, 1, 1);
431 break;
432
cea5d8c9 433 case OP_LBZU:
bbf45ba5 434 emulated = kvmppc_handle_load(run, vcpu, rt, 1, 1);
6020c0f6 435 kvmppc_set_gpr(vcpu, ra, vcpu->arch.vaddr_accessed);
bbf45ba5
HB
436 break;
437
cea5d8c9 438 case OP_STW:
8e5b26b5
AG
439 emulated = kvmppc_handle_store(run, vcpu,
440 kvmppc_get_gpr(vcpu, rs),
bbf45ba5
HB
441 4, 1);
442 break;
443
6c5cb739
VS
444 /* TBD: Add support for other 64 bit store variants like stdu, stdux, stdx etc. */
445 case OP_STD:
446 rs = get_rs(inst);
447 emulated = kvmppc_handle_store(run, vcpu,
448 kvmppc_get_gpr(vcpu, rs),
449 8, 1);
450 break;
451
cea5d8c9 452 case OP_STWU:
8e5b26b5
AG
453 emulated = kvmppc_handle_store(run, vcpu,
454 kvmppc_get_gpr(vcpu, rs),
bbf45ba5 455 4, 1);
6020c0f6 456 kvmppc_set_gpr(vcpu, ra, vcpu->arch.vaddr_accessed);
bbf45ba5
HB
457 break;
458
cea5d8c9 459 case OP_STB:
8e5b26b5
AG
460 emulated = kvmppc_handle_store(run, vcpu,
461 kvmppc_get_gpr(vcpu, rs),
bbf45ba5
HB
462 1, 1);
463 break;
464
cea5d8c9 465 case OP_STBU:
8e5b26b5
AG
466 emulated = kvmppc_handle_store(run, vcpu,
467 kvmppc_get_gpr(vcpu, rs),
bbf45ba5 468 1, 1);
6020c0f6 469 kvmppc_set_gpr(vcpu, ra, vcpu->arch.vaddr_accessed);
bbf45ba5
HB
470 break;
471
cea5d8c9 472 case OP_LHZ:
bbf45ba5
HB
473 emulated = kvmppc_handle_load(run, vcpu, rt, 2, 1);
474 break;
475
cea5d8c9 476 case OP_LHZU:
bbf45ba5 477 emulated = kvmppc_handle_load(run, vcpu, rt, 2, 1);
6020c0f6 478 kvmppc_set_gpr(vcpu, ra, vcpu->arch.vaddr_accessed);
bbf45ba5
HB
479 break;
480
3587d534 481 case OP_LHA:
3587d534
AG
482 emulated = kvmppc_handle_loads(run, vcpu, rt, 2, 1);
483 break;
484
485 case OP_LHAU:
3587d534 486 emulated = kvmppc_handle_loads(run, vcpu, rt, 2, 1);
6020c0f6 487 kvmppc_set_gpr(vcpu, ra, vcpu->arch.vaddr_accessed);
3587d534
AG
488 break;
489
cea5d8c9 490 case OP_STH:
8e5b26b5
AG
491 emulated = kvmppc_handle_store(run, vcpu,
492 kvmppc_get_gpr(vcpu, rs),
bbf45ba5
HB
493 2, 1);
494 break;
495
cea5d8c9 496 case OP_STHU:
8e5b26b5
AG
497 emulated = kvmppc_handle_store(run, vcpu,
498 kvmppc_get_gpr(vcpu, rs),
bbf45ba5 499 2, 1);
6020c0f6 500 kvmppc_set_gpr(vcpu, ra, vcpu->arch.vaddr_accessed);
bbf45ba5
HB
501 break;
502
503 default:
bbf45ba5 504 emulated = EMULATE_FAIL;
75f74f0d
HB
505 }
506
507 if (emulated == EMULATE_FAIL) {
508 emulated = kvmppc_core_emulate_op(run, vcpu, inst, &advance);
37f5bca6
AG
509 if (emulated == EMULATE_AGAIN) {
510 advance = 0;
511 } else if (emulated == EMULATE_FAIL) {
75f74f0d
HB
512 advance = 0;
513 printk(KERN_ERR "Couldn't emulate instruction 0x%08x "
514 "(op %d xop %d)\n", inst, get_op(inst), get_xop(inst));
5f2b105a 515 kvmppc_core_queue_program(vcpu, 0);
75f74f0d 516 }
bbf45ba5
HB
517 }
518
c7f38f46 519 trace_kvm_ppc_instr(inst, kvmppc_get_pc(vcpu), emulated);
3b4bd796 520
c7f38f46 521 /* Advance past emulated instruction. */
bbf45ba5 522 if (advance)
c7f38f46 523 kvmppc_set_pc(vcpu, kvmppc_get_pc(vcpu) + 4);
bbf45ba5
HB
524
525 return emulated;
526}