blob: e70ef2d86431bd7eef8c93adf219a88009ea6828 [file] [log] [blame]
Alexander Graf831317b2010-02-19 11:00:44 +01001/*
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 Novell Inc 2010
16 *
17 * Authors: Alexander Graf <agraf@suse.de>
18 */
19
20#include <asm/kvm.h>
21#include <asm/kvm_ppc.h>
22#include <asm/disassemble.h>
23#include <asm/kvm_book3s.h>
24#include <asm/kvm_fpu.h>
25#include <asm/reg.h>
26#include <asm/cacheflush.h>
27#include <linux/vmalloc.h>
28
29/* #define DEBUG */
30
31#ifdef DEBUG
32#define dprintk printk
33#else
34#define dprintk(...) do { } while(0);
35#endif
36
37#define OP_LFS 48
38#define OP_LFSU 49
39#define OP_LFD 50
40#define OP_LFDU 51
41#define OP_STFS 52
42#define OP_STFSU 53
43#define OP_STFD 54
44#define OP_STFDU 55
45#define OP_PSQ_L 56
46#define OP_PSQ_LU 57
47#define OP_PSQ_ST 60
48#define OP_PSQ_STU 61
49
50#define OP_31_LFSX 535
51#define OP_31_LFSUX 567
52#define OP_31_LFDX 599
53#define OP_31_LFDUX 631
54#define OP_31_STFSX 663
55#define OP_31_STFSUX 695
56#define OP_31_STFX 727
57#define OP_31_STFUX 759
58#define OP_31_LWIZX 887
59#define OP_31_STFIWX 983
60
61#define OP_59_FADDS 21
62#define OP_59_FSUBS 20
63#define OP_59_FSQRTS 22
64#define OP_59_FDIVS 18
65#define OP_59_FRES 24
66#define OP_59_FMULS 25
67#define OP_59_FRSQRTES 26
68#define OP_59_FMSUBS 28
69#define OP_59_FMADDS 29
70#define OP_59_FNMSUBS 30
71#define OP_59_FNMADDS 31
72
73#define OP_63_FCMPU 0
74#define OP_63_FCPSGN 8
75#define OP_63_FRSP 12
76#define OP_63_FCTIW 14
77#define OP_63_FCTIWZ 15
78#define OP_63_FDIV 18
79#define OP_63_FADD 21
80#define OP_63_FSQRT 22
81#define OP_63_FSEL 23
82#define OP_63_FRE 24
83#define OP_63_FMUL 25
84#define OP_63_FRSQRTE 26
85#define OP_63_FMSUB 28
86#define OP_63_FMADD 29
87#define OP_63_FNMSUB 30
88#define OP_63_FNMADD 31
89#define OP_63_FCMPO 32
90#define OP_63_MTFSB1 38 // XXX
91#define OP_63_FSUB 20
92#define OP_63_FNEG 40
93#define OP_63_MCRFS 64
94#define OP_63_MTFSB0 70
95#define OP_63_FMR 72
96#define OP_63_MTFSFI 134
97#define OP_63_FABS 264
98#define OP_63_MFFS 583
99#define OP_63_MTFSF 711
100
101#define OP_4X_PS_CMPU0 0
102#define OP_4X_PSQ_LX 6
103#define OP_4XW_PSQ_STX 7
104#define OP_4A_PS_SUM0 10
105#define OP_4A_PS_SUM1 11
106#define OP_4A_PS_MULS0 12
107#define OP_4A_PS_MULS1 13
108#define OP_4A_PS_MADDS0 14
109#define OP_4A_PS_MADDS1 15
110#define OP_4A_PS_DIV 18
111#define OP_4A_PS_SUB 20
112#define OP_4A_PS_ADD 21
113#define OP_4A_PS_SEL 23
114#define OP_4A_PS_RES 24
115#define OP_4A_PS_MUL 25
116#define OP_4A_PS_RSQRTE 26
117#define OP_4A_PS_MSUB 28
118#define OP_4A_PS_MADD 29
119#define OP_4A_PS_NMSUB 30
120#define OP_4A_PS_NMADD 31
121#define OP_4X_PS_CMPO0 32
122#define OP_4X_PSQ_LUX 38
123#define OP_4XW_PSQ_STUX 39
124#define OP_4X_PS_NEG 40
125#define OP_4X_PS_CMPU1 64
126#define OP_4X_PS_MR 72
127#define OP_4X_PS_CMPO1 96
128#define OP_4X_PS_NABS 136
129#define OP_4X_PS_ABS 264
130#define OP_4X_PS_MERGE00 528
131#define OP_4X_PS_MERGE01 560
132#define OP_4X_PS_MERGE10 592
133#define OP_4X_PS_MERGE11 624
134
135#define SCALAR_NONE 0
136#define SCALAR_HIGH (1 << 0)
137#define SCALAR_LOW (1 << 1)
138#define SCALAR_NO_PS0 (1 << 2)
139#define SCALAR_NO_PS1 (1 << 3)
140
141#define GQR_ST_TYPE_MASK 0x00000007
142#define GQR_ST_TYPE_SHIFT 0
143#define GQR_ST_SCALE_MASK 0x00003f00
144#define GQR_ST_SCALE_SHIFT 8
145#define GQR_LD_TYPE_MASK 0x00070000
146#define GQR_LD_TYPE_SHIFT 16
147#define GQR_LD_SCALE_MASK 0x3f000000
148#define GQR_LD_SCALE_SHIFT 24
149
150#define GQR_QUANTIZE_FLOAT 0
151#define GQR_QUANTIZE_U8 4
152#define GQR_QUANTIZE_U16 5
153#define GQR_QUANTIZE_S8 6
154#define GQR_QUANTIZE_S16 7
155
156#define FPU_LS_SINGLE 0
157#define FPU_LS_DOUBLE 1
158#define FPU_LS_SINGLE_LOW 2
159
160static inline void kvmppc_sync_qpr(struct kvm_vcpu *vcpu, int rt)
161{
Andreas Schwab05d77ac2010-08-21 11:43:20 +0000162 kvm_cvt_df(&vcpu->arch.fpr[rt], &vcpu->arch.qpr[rt]);
Alexander Graf831317b2010-02-19 11:00:44 +0100163}
164
165static void kvmppc_inject_pf(struct kvm_vcpu *vcpu, ulong eaddr, bool is_store)
166{
167 u64 dsisr;
Alexander Graf666e7252010-07-29 14:47:43 +0200168 struct kvm_vcpu_arch_shared *shared = vcpu->arch.shared;
Alexander Graf831317b2010-02-19 11:00:44 +0100169
Alexander Graf666e7252010-07-29 14:47:43 +0200170 shared->msr = kvmppc_set_field(shared->msr, 33, 36, 0);
171 shared->msr = kvmppc_set_field(shared->msr, 42, 47, 0);
Alexander Graf5e030182010-07-29 14:47:45 +0200172 shared->dar = eaddr;
Alexander Graf831317b2010-02-19 11:00:44 +0100173 /* Page Fault */
174 dsisr = kvmppc_set_field(0, 33, 33, 1);
175 if (is_store)
Alexander Grafd562de42010-07-29 14:47:44 +0200176 shared->dsisr = kvmppc_set_field(dsisr, 38, 38, 1);
Alexander Graf831317b2010-02-19 11:00:44 +0100177 kvmppc_book3s_queue_irqprio(vcpu, BOOK3S_INTERRUPT_DATA_STORAGE);
178}
179
180static int kvmppc_emulate_fpr_load(struct kvm_run *run, struct kvm_vcpu *vcpu,
181 int rs, ulong addr, int ls_type)
182{
183 int emulated = EMULATE_FAIL;
Alexander Graf831317b2010-02-19 11:00:44 +0100184 int r;
185 char tmp[8];
186 int len = sizeof(u32);
187
188 if (ls_type == FPU_LS_DOUBLE)
189 len = sizeof(u64);
190
Alexander Graf831317b2010-02-19 11:00:44 +0100191 /* read from memory */
192 r = kvmppc_ld(vcpu, &addr, len, tmp, true);
193 vcpu->arch.paddr_accessed = addr;
194
195 if (r < 0) {
196 kvmppc_inject_pf(vcpu, addr, false);
197 goto done_load;
198 } else if (r == EMULATE_DO_MMIO) {
Alexander Grafb3c5d3c2012-01-07 02:07:38 +0100199 emulated = kvmppc_handle_load(run, vcpu, KVM_MMIO_REG_FPR | rs,
200 len, 1);
Alexander Graf831317b2010-02-19 11:00:44 +0100201 goto done_load;
202 }
203
204 emulated = EMULATE_DONE;
205
206 /* put in registers */
207 switch (ls_type) {
208 case FPU_LS_SINGLE:
Andreas Schwab05d77ac2010-08-21 11:43:20 +0000209 kvm_cvt_fd((u32*)tmp, &vcpu->arch.fpr[rs]);
Alexander Graf831317b2010-02-19 11:00:44 +0100210 vcpu->arch.qpr[rs] = *((u32*)tmp);
211 break;
212 case FPU_LS_DOUBLE:
213 vcpu->arch.fpr[rs] = *((u64*)tmp);
214 break;
215 }
216
217 dprintk(KERN_INFO "KVM: FPR_LD [0x%llx] at 0x%lx (%d)\n", *(u64*)tmp,
218 addr, len);
219
220done_load:
221 return emulated;
222}
223
224static int kvmppc_emulate_fpr_store(struct kvm_run *run, struct kvm_vcpu *vcpu,
225 int rs, ulong addr, int ls_type)
226{
227 int emulated = EMULATE_FAIL;
Alexander Graf831317b2010-02-19 11:00:44 +0100228 int r;
229 char tmp[8];
230 u64 val;
231 int len;
232
Alexander Graf831317b2010-02-19 11:00:44 +0100233 switch (ls_type) {
234 case FPU_LS_SINGLE:
Andreas Schwab05d77ac2010-08-21 11:43:20 +0000235 kvm_cvt_df(&vcpu->arch.fpr[rs], (u32*)tmp);
Alexander Graf831317b2010-02-19 11:00:44 +0100236 val = *((u32*)tmp);
237 len = sizeof(u32);
238 break;
239 case FPU_LS_SINGLE_LOW:
240 *((u32*)tmp) = vcpu->arch.fpr[rs];
241 val = vcpu->arch.fpr[rs] & 0xffffffff;
242 len = sizeof(u32);
243 break;
244 case FPU_LS_DOUBLE:
245 *((u64*)tmp) = vcpu->arch.fpr[rs];
246 val = vcpu->arch.fpr[rs];
247 len = sizeof(u64);
248 break;
249 default:
250 val = 0;
251 len = 0;
252 }
253
254 r = kvmppc_st(vcpu, &addr, len, tmp, true);
255 vcpu->arch.paddr_accessed = addr;
256 if (r < 0) {
257 kvmppc_inject_pf(vcpu, addr, true);
258 } else if (r == EMULATE_DO_MMIO) {
259 emulated = kvmppc_handle_store(run, vcpu, val, len, 1);
260 } else {
261 emulated = EMULATE_DONE;
262 }
263
264 dprintk(KERN_INFO "KVM: FPR_ST [0x%llx] at 0x%lx (%d)\n",
265 val, addr, len);
266
267 return emulated;
268}
269
270static int kvmppc_emulate_psq_load(struct kvm_run *run, struct kvm_vcpu *vcpu,
271 int rs, ulong addr, bool w, int i)
272{
273 int emulated = EMULATE_FAIL;
Alexander Graf831317b2010-02-19 11:00:44 +0100274 int r;
275 float one = 1.0;
276 u32 tmp[2];
277
Alexander Graf831317b2010-02-19 11:00:44 +0100278 /* read from memory */
279 if (w) {
280 r = kvmppc_ld(vcpu, &addr, sizeof(u32), tmp, true);
281 memcpy(&tmp[1], &one, sizeof(u32));
282 } else {
283 r = kvmppc_ld(vcpu, &addr, sizeof(u32) * 2, tmp, true);
284 }
285 vcpu->arch.paddr_accessed = addr;
286 if (r < 0) {
287 kvmppc_inject_pf(vcpu, addr, false);
288 goto done_load;
289 } else if ((r == EMULATE_DO_MMIO) && w) {
Alexander Grafb3c5d3c2012-01-07 02:07:38 +0100290 emulated = kvmppc_handle_load(run, vcpu, KVM_MMIO_REG_FPR | rs,
291 4, 1);
Alexander Graf831317b2010-02-19 11:00:44 +0100292 vcpu->arch.qpr[rs] = tmp[1];
293 goto done_load;
294 } else if (r == EMULATE_DO_MMIO) {
Alexander Grafb3c5d3c2012-01-07 02:07:38 +0100295 emulated = kvmppc_handle_load(run, vcpu, KVM_MMIO_REG_FQPR | rs,
296 8, 1);
Alexander Graf831317b2010-02-19 11:00:44 +0100297 goto done_load;
298 }
299
300 emulated = EMULATE_DONE;
301
302 /* put in registers */
Andreas Schwab05d77ac2010-08-21 11:43:20 +0000303 kvm_cvt_fd(&tmp[0], &vcpu->arch.fpr[rs]);
Alexander Graf831317b2010-02-19 11:00:44 +0100304 vcpu->arch.qpr[rs] = tmp[1];
305
306 dprintk(KERN_INFO "KVM: PSQ_LD [0x%x, 0x%x] at 0x%lx (%d)\n", tmp[0],
307 tmp[1], addr, w ? 4 : 8);
308
309done_load:
310 return emulated;
311}
312
313static int kvmppc_emulate_psq_store(struct kvm_run *run, struct kvm_vcpu *vcpu,
314 int rs, ulong addr, bool w, int i)
315{
316 int emulated = EMULATE_FAIL;
Alexander Graf831317b2010-02-19 11:00:44 +0100317 int r;
318 u32 tmp[2];
319 int len = w ? sizeof(u32) : sizeof(u64);
320
Andreas Schwab05d77ac2010-08-21 11:43:20 +0000321 kvm_cvt_df(&vcpu->arch.fpr[rs], &tmp[0]);
Alexander Graf831317b2010-02-19 11:00:44 +0100322 tmp[1] = vcpu->arch.qpr[rs];
323
324 r = kvmppc_st(vcpu, &addr, len, tmp, true);
325 vcpu->arch.paddr_accessed = addr;
326 if (r < 0) {
327 kvmppc_inject_pf(vcpu, addr, true);
328 } else if ((r == EMULATE_DO_MMIO) && w) {
329 emulated = kvmppc_handle_store(run, vcpu, tmp[0], 4, 1);
330 } else if (r == EMULATE_DO_MMIO) {
331 u64 val = ((u64)tmp[0] << 32) | tmp[1];
332 emulated = kvmppc_handle_store(run, vcpu, val, 8, 1);
333 } else {
334 emulated = EMULATE_DONE;
335 }
336
337 dprintk(KERN_INFO "KVM: PSQ_ST [0x%x, 0x%x] at 0x%lx (%d)\n",
338 tmp[0], tmp[1], addr, len);
339
340 return emulated;
341}
342
343/*
344 * Cuts out inst bits with ordering according to spec.
345 * That means the leftmost bit is zero. All given bits are included.
346 */
347static inline u32 inst_get_field(u32 inst, int msb, int lsb)
348{
349 return kvmppc_get_field(inst, msb + 32, lsb + 32);
350}
351
352/*
353 * Replaces inst bits with ordering according to spec.
354 */
355static inline u32 inst_set_field(u32 inst, int msb, int lsb, int value)
356{
357 return kvmppc_set_field(inst, msb + 32, lsb + 32, value);
358}
359
360bool kvmppc_inst_is_paired_single(struct kvm_vcpu *vcpu, u32 inst)
361{
362 if (!(vcpu->arch.hflags & BOOK3S_HFLAG_PAIRED_SINGLE))
363 return false;
364
365 switch (get_op(inst)) {
366 case OP_PSQ_L:
367 case OP_PSQ_LU:
368 case OP_PSQ_ST:
369 case OP_PSQ_STU:
370 case OP_LFS:
371 case OP_LFSU:
372 case OP_LFD:
373 case OP_LFDU:
374 case OP_STFS:
375 case OP_STFSU:
376 case OP_STFD:
377 case OP_STFDU:
378 return true;
379 case 4:
380 /* X form */
381 switch (inst_get_field(inst, 21, 30)) {
382 case OP_4X_PS_CMPU0:
383 case OP_4X_PSQ_LX:
384 case OP_4X_PS_CMPO0:
385 case OP_4X_PSQ_LUX:
386 case OP_4X_PS_NEG:
387 case OP_4X_PS_CMPU1:
388 case OP_4X_PS_MR:
389 case OP_4X_PS_CMPO1:
390 case OP_4X_PS_NABS:
391 case OP_4X_PS_ABS:
392 case OP_4X_PS_MERGE00:
393 case OP_4X_PS_MERGE01:
394 case OP_4X_PS_MERGE10:
395 case OP_4X_PS_MERGE11:
396 return true;
397 }
398 /* XW form */
399 switch (inst_get_field(inst, 25, 30)) {
400 case OP_4XW_PSQ_STX:
401 case OP_4XW_PSQ_STUX:
402 return true;
403 }
404 /* A form */
405 switch (inst_get_field(inst, 26, 30)) {
406 case OP_4A_PS_SUM1:
407 case OP_4A_PS_SUM0:
408 case OP_4A_PS_MULS0:
409 case OP_4A_PS_MULS1:
410 case OP_4A_PS_MADDS0:
411 case OP_4A_PS_MADDS1:
412 case OP_4A_PS_DIV:
413 case OP_4A_PS_SUB:
414 case OP_4A_PS_ADD:
415 case OP_4A_PS_SEL:
416 case OP_4A_PS_RES:
417 case OP_4A_PS_MUL:
418 case OP_4A_PS_RSQRTE:
419 case OP_4A_PS_MSUB:
420 case OP_4A_PS_MADD:
421 case OP_4A_PS_NMSUB:
422 case OP_4A_PS_NMADD:
423 return true;
424 }
425 break;
426 case 59:
427 switch (inst_get_field(inst, 21, 30)) {
428 case OP_59_FADDS:
429 case OP_59_FSUBS:
430 case OP_59_FDIVS:
431 case OP_59_FRES:
432 case OP_59_FRSQRTES:
433 return true;
434 }
435 switch (inst_get_field(inst, 26, 30)) {
436 case OP_59_FMULS:
437 case OP_59_FMSUBS:
438 case OP_59_FMADDS:
439 case OP_59_FNMSUBS:
440 case OP_59_FNMADDS:
441 return true;
442 }
443 break;
444 case 63:
445 switch (inst_get_field(inst, 21, 30)) {
446 case OP_63_MTFSB0:
447 case OP_63_MTFSB1:
448 case OP_63_MTFSF:
449 case OP_63_MTFSFI:
450 case OP_63_MCRFS:
451 case OP_63_MFFS:
452 case OP_63_FCMPU:
453 case OP_63_FCMPO:
454 case OP_63_FNEG:
455 case OP_63_FMR:
456 case OP_63_FABS:
457 case OP_63_FRSP:
458 case OP_63_FDIV:
459 case OP_63_FADD:
460 case OP_63_FSUB:
461 case OP_63_FCTIW:
462 case OP_63_FCTIWZ:
463 case OP_63_FRSQRTE:
464 case OP_63_FCPSGN:
465 return true;
466 }
467 switch (inst_get_field(inst, 26, 30)) {
468 case OP_63_FMUL:
469 case OP_63_FSEL:
470 case OP_63_FMSUB:
471 case OP_63_FMADD:
472 case OP_63_FNMSUB:
473 case OP_63_FNMADD:
474 return true;
475 }
476 break;
477 case 31:
478 switch (inst_get_field(inst, 21, 30)) {
479 case OP_31_LFSX:
480 case OP_31_LFSUX:
481 case OP_31_LFDX:
482 case OP_31_LFDUX:
483 case OP_31_STFSX:
484 case OP_31_STFSUX:
485 case OP_31_STFX:
486 case OP_31_STFUX:
487 case OP_31_STFIWX:
488 return true;
489 }
490 break;
491 }
492
493 return false;
494}
495
496static int get_d_signext(u32 inst)
497{
498 int d = inst & 0x8ff;
499
500 if (d & 0x800)
501 return -(d & 0x7ff);
502
503 return (d & 0x7ff);
504}
505
506static int kvmppc_ps_three_in(struct kvm_vcpu *vcpu, bool rc,
507 int reg_out, int reg_in1, int reg_in2,
508 int reg_in3, int scalar,
Andreas Schwab49f6be82010-05-31 21:59:13 +0200509 void (*func)(u64 *fpscr,
Alexander Graf831317b2010-02-19 11:00:44 +0100510 u32 *dst, u32 *src1,
511 u32 *src2, u32 *src3))
512{
513 u32 *qpr = vcpu->arch.qpr;
514 u64 *fpr = vcpu->arch.fpr;
515 u32 ps0_out;
516 u32 ps0_in1, ps0_in2, ps0_in3;
517 u32 ps1_in1, ps1_in2, ps1_in3;
Alexander Graf831317b2010-02-19 11:00:44 +0100518
519 /* RC */
520 WARN_ON(rc);
521
522 /* PS0 */
Andreas Schwab05d77ac2010-08-21 11:43:20 +0000523 kvm_cvt_df(&fpr[reg_in1], &ps0_in1);
524 kvm_cvt_df(&fpr[reg_in2], &ps0_in2);
525 kvm_cvt_df(&fpr[reg_in3], &ps0_in3);
Alexander Graf831317b2010-02-19 11:00:44 +0100526
527 if (scalar & SCALAR_LOW)
528 ps0_in2 = qpr[reg_in2];
529
Andreas Schwab49f6be82010-05-31 21:59:13 +0200530 func(&vcpu->arch.fpscr, &ps0_out, &ps0_in1, &ps0_in2, &ps0_in3);
Alexander Graf831317b2010-02-19 11:00:44 +0100531
532 dprintk(KERN_INFO "PS3 ps0 -> f(0x%x, 0x%x, 0x%x) = 0x%x\n",
533 ps0_in1, ps0_in2, ps0_in3, ps0_out);
534
535 if (!(scalar & SCALAR_NO_PS0))
Andreas Schwab05d77ac2010-08-21 11:43:20 +0000536 kvm_cvt_fd(&ps0_out, &fpr[reg_out]);
Alexander Graf831317b2010-02-19 11:00:44 +0100537
538 /* PS1 */
539 ps1_in1 = qpr[reg_in1];
540 ps1_in2 = qpr[reg_in2];
541 ps1_in3 = qpr[reg_in3];
542
543 if (scalar & SCALAR_HIGH)
544 ps1_in2 = ps0_in2;
545
546 if (!(scalar & SCALAR_NO_PS1))
Andreas Schwab49f6be82010-05-31 21:59:13 +0200547 func(&vcpu->arch.fpscr, &qpr[reg_out], &ps1_in1, &ps1_in2, &ps1_in3);
Alexander Graf831317b2010-02-19 11:00:44 +0100548
549 dprintk(KERN_INFO "PS3 ps1 -> f(0x%x, 0x%x, 0x%x) = 0x%x\n",
550 ps1_in1, ps1_in2, ps1_in3, qpr[reg_out]);
551
552 return EMULATE_DONE;
553}
554
555static int kvmppc_ps_two_in(struct kvm_vcpu *vcpu, bool rc,
556 int reg_out, int reg_in1, int reg_in2,
557 int scalar,
Andreas Schwab49f6be82010-05-31 21:59:13 +0200558 void (*func)(u64 *fpscr,
Alexander Graf831317b2010-02-19 11:00:44 +0100559 u32 *dst, u32 *src1,
560 u32 *src2))
561{
562 u32 *qpr = vcpu->arch.qpr;
563 u64 *fpr = vcpu->arch.fpr;
564 u32 ps0_out;
565 u32 ps0_in1, ps0_in2;
566 u32 ps1_out;
567 u32 ps1_in1, ps1_in2;
Alexander Graf831317b2010-02-19 11:00:44 +0100568
569 /* RC */
570 WARN_ON(rc);
571
572 /* PS0 */
Andreas Schwab05d77ac2010-08-21 11:43:20 +0000573 kvm_cvt_df(&fpr[reg_in1], &ps0_in1);
Alexander Graf831317b2010-02-19 11:00:44 +0100574
575 if (scalar & SCALAR_LOW)
576 ps0_in2 = qpr[reg_in2];
577 else
Andreas Schwab05d77ac2010-08-21 11:43:20 +0000578 kvm_cvt_df(&fpr[reg_in2], &ps0_in2);
Alexander Graf831317b2010-02-19 11:00:44 +0100579
Andreas Schwab49f6be82010-05-31 21:59:13 +0200580 func(&vcpu->arch.fpscr, &ps0_out, &ps0_in1, &ps0_in2);
Alexander Graf831317b2010-02-19 11:00:44 +0100581
582 if (!(scalar & SCALAR_NO_PS0)) {
583 dprintk(KERN_INFO "PS2 ps0 -> f(0x%x, 0x%x) = 0x%x\n",
584 ps0_in1, ps0_in2, ps0_out);
585
Andreas Schwab05d77ac2010-08-21 11:43:20 +0000586 kvm_cvt_fd(&ps0_out, &fpr[reg_out]);
Alexander Graf831317b2010-02-19 11:00:44 +0100587 }
588
589 /* PS1 */
590 ps1_in1 = qpr[reg_in1];
591 ps1_in2 = qpr[reg_in2];
592
593 if (scalar & SCALAR_HIGH)
594 ps1_in2 = ps0_in2;
595
Andreas Schwab49f6be82010-05-31 21:59:13 +0200596 func(&vcpu->arch.fpscr, &ps1_out, &ps1_in1, &ps1_in2);
Alexander Graf831317b2010-02-19 11:00:44 +0100597
598 if (!(scalar & SCALAR_NO_PS1)) {
599 qpr[reg_out] = ps1_out;
600
601 dprintk(KERN_INFO "PS2 ps1 -> f(0x%x, 0x%x) = 0x%x\n",
602 ps1_in1, ps1_in2, qpr[reg_out]);
603 }
604
605 return EMULATE_DONE;
606}
607
608static int kvmppc_ps_one_in(struct kvm_vcpu *vcpu, bool rc,
609 int reg_out, int reg_in,
Andreas Schwab49f6be82010-05-31 21:59:13 +0200610 void (*func)(u64 *t,
Alexander Graf831317b2010-02-19 11:00:44 +0100611 u32 *dst, u32 *src1))
612{
613 u32 *qpr = vcpu->arch.qpr;
614 u64 *fpr = vcpu->arch.fpr;
615 u32 ps0_out, ps0_in;
616 u32 ps1_in;
Alexander Graf831317b2010-02-19 11:00:44 +0100617
618 /* RC */
619 WARN_ON(rc);
620
621 /* PS0 */
Andreas Schwab05d77ac2010-08-21 11:43:20 +0000622 kvm_cvt_df(&fpr[reg_in], &ps0_in);
Andreas Schwab49f6be82010-05-31 21:59:13 +0200623 func(&vcpu->arch.fpscr, &ps0_out, &ps0_in);
Alexander Graf831317b2010-02-19 11:00:44 +0100624
625 dprintk(KERN_INFO "PS1 ps0 -> f(0x%x) = 0x%x\n",
626 ps0_in, ps0_out);
627
Andreas Schwab05d77ac2010-08-21 11:43:20 +0000628 kvm_cvt_fd(&ps0_out, &fpr[reg_out]);
Alexander Graf831317b2010-02-19 11:00:44 +0100629
630 /* PS1 */
631 ps1_in = qpr[reg_in];
Andreas Schwab49f6be82010-05-31 21:59:13 +0200632 func(&vcpu->arch.fpscr, &qpr[reg_out], &ps1_in);
Alexander Graf831317b2010-02-19 11:00:44 +0100633
634 dprintk(KERN_INFO "PS1 ps1 -> f(0x%x) = 0x%x\n",
635 ps1_in, qpr[reg_out]);
636
637 return EMULATE_DONE;
638}
639
640int kvmppc_emulate_paired_single(struct kvm_run *run, struct kvm_vcpu *vcpu)
641{
Alexander Grafc7f38f42010-04-16 00:11:40 +0200642 u32 inst = kvmppc_get_last_inst(vcpu);
Alexander Graf831317b2010-02-19 11:00:44 +0100643 enum emulation_result emulated = EMULATE_DONE;
644
645 int ax_rd = inst_get_field(inst, 6, 10);
646 int ax_ra = inst_get_field(inst, 11, 15);
647 int ax_rb = inst_get_field(inst, 16, 20);
648 int ax_rc = inst_get_field(inst, 21, 25);
649 short full_d = inst_get_field(inst, 16, 31);
650
651 u64 *fpr_d = &vcpu->arch.fpr[ax_rd];
652 u64 *fpr_a = &vcpu->arch.fpr[ax_ra];
653 u64 *fpr_b = &vcpu->arch.fpr[ax_rb];
654 u64 *fpr_c = &vcpu->arch.fpr[ax_rc];
655
656 bool rcomp = (inst & 1) ? true : false;
657 u32 cr = kvmppc_get_cr(vcpu);
Alexander Graf831317b2010-02-19 11:00:44 +0100658#ifdef DEBUG
659 int i;
660#endif
661
Alexander Graf831317b2010-02-19 11:00:44 +0100662 if (!kvmppc_inst_is_paired_single(vcpu, inst))
663 return EMULATE_FAIL;
664
Alexander Graf666e7252010-07-29 14:47:43 +0200665 if (!(vcpu->arch.shared->msr & MSR_FP)) {
Alexander Graf831317b2010-02-19 11:00:44 +0100666 kvmppc_book3s_queue_irqprio(vcpu, BOOK3S_INTERRUPT_FP_UNAVAIL);
667 return EMULATE_AGAIN;
668 }
669
670 kvmppc_giveup_ext(vcpu, MSR_FP);
671 preempt_disable();
672 enable_kernel_fp();
673 /* Do we need to clear FE0 / FE1 here? Don't think so. */
674
675#ifdef DEBUG
676 for (i = 0; i < ARRAY_SIZE(vcpu->arch.fpr); i++) {
677 u32 f;
Andreas Schwab05d77ac2010-08-21 11:43:20 +0000678 kvm_cvt_df(&vcpu->arch.fpr[i], &f);
Alexander Graf831317b2010-02-19 11:00:44 +0100679 dprintk(KERN_INFO "FPR[%d] = 0x%x / 0x%llx QPR[%d] = 0x%x\n",
680 i, f, vcpu->arch.fpr[i], i, vcpu->arch.qpr[i]);
681 }
682#endif
683
684 switch (get_op(inst)) {
685 case OP_PSQ_L:
686 {
687 ulong addr = ax_ra ? kvmppc_get_gpr(vcpu, ax_ra) : 0;
688 bool w = inst_get_field(inst, 16, 16) ? true : false;
689 int i = inst_get_field(inst, 17, 19);
690
691 addr += get_d_signext(inst);
692 emulated = kvmppc_emulate_psq_load(run, vcpu, ax_rd, addr, w, i);
693 break;
694 }
695 case OP_PSQ_LU:
696 {
697 ulong addr = kvmppc_get_gpr(vcpu, ax_ra);
698 bool w = inst_get_field(inst, 16, 16) ? true : false;
699 int i = inst_get_field(inst, 17, 19);
700
701 addr += get_d_signext(inst);
702 emulated = kvmppc_emulate_psq_load(run, vcpu, ax_rd, addr, w, i);
703
704 if (emulated == EMULATE_DONE)
705 kvmppc_set_gpr(vcpu, ax_ra, addr);
706 break;
707 }
708 case OP_PSQ_ST:
709 {
710 ulong addr = ax_ra ? kvmppc_get_gpr(vcpu, ax_ra) : 0;
711 bool w = inst_get_field(inst, 16, 16) ? true : false;
712 int i = inst_get_field(inst, 17, 19);
713
714 addr += get_d_signext(inst);
715 emulated = kvmppc_emulate_psq_store(run, vcpu, ax_rd, addr, w, i);
716 break;
717 }
718 case OP_PSQ_STU:
719 {
720 ulong addr = kvmppc_get_gpr(vcpu, ax_ra);
721 bool w = inst_get_field(inst, 16, 16) ? true : false;
722 int i = inst_get_field(inst, 17, 19);
723
724 addr += get_d_signext(inst);
725 emulated = kvmppc_emulate_psq_store(run, vcpu, ax_rd, addr, w, i);
726
727 if (emulated == EMULATE_DONE)
728 kvmppc_set_gpr(vcpu, ax_ra, addr);
729 break;
730 }
731 case 4:
732 /* X form */
733 switch (inst_get_field(inst, 21, 30)) {
734 case OP_4X_PS_CMPU0:
735 /* XXX */
736 emulated = EMULATE_FAIL;
737 break;
738 case OP_4X_PSQ_LX:
739 {
740 ulong addr = ax_ra ? kvmppc_get_gpr(vcpu, ax_ra) : 0;
741 bool w = inst_get_field(inst, 21, 21) ? true : false;
742 int i = inst_get_field(inst, 22, 24);
743
744 addr += kvmppc_get_gpr(vcpu, ax_rb);
745 emulated = kvmppc_emulate_psq_load(run, vcpu, ax_rd, addr, w, i);
746 break;
747 }
748 case OP_4X_PS_CMPO0:
749 /* XXX */
750 emulated = EMULATE_FAIL;
751 break;
752 case OP_4X_PSQ_LUX:
753 {
754 ulong addr = kvmppc_get_gpr(vcpu, ax_ra);
755 bool w = inst_get_field(inst, 21, 21) ? true : false;
756 int i = inst_get_field(inst, 22, 24);
757
758 addr += kvmppc_get_gpr(vcpu, ax_rb);
759 emulated = kvmppc_emulate_psq_load(run, vcpu, ax_rd, addr, w, i);
760
761 if (emulated == EMULATE_DONE)
762 kvmppc_set_gpr(vcpu, ax_ra, addr);
763 break;
764 }
765 case OP_4X_PS_NEG:
766 vcpu->arch.fpr[ax_rd] = vcpu->arch.fpr[ax_rb];
767 vcpu->arch.fpr[ax_rd] ^= 0x8000000000000000ULL;
768 vcpu->arch.qpr[ax_rd] = vcpu->arch.qpr[ax_rb];
769 vcpu->arch.qpr[ax_rd] ^= 0x80000000;
770 break;
771 case OP_4X_PS_CMPU1:
772 /* XXX */
773 emulated = EMULATE_FAIL;
774 break;
775 case OP_4X_PS_MR:
776 WARN_ON(rcomp);
777 vcpu->arch.fpr[ax_rd] = vcpu->arch.fpr[ax_rb];
778 vcpu->arch.qpr[ax_rd] = vcpu->arch.qpr[ax_rb];
779 break;
780 case OP_4X_PS_CMPO1:
781 /* XXX */
782 emulated = EMULATE_FAIL;
783 break;
784 case OP_4X_PS_NABS:
785 WARN_ON(rcomp);
786 vcpu->arch.fpr[ax_rd] = vcpu->arch.fpr[ax_rb];
787 vcpu->arch.fpr[ax_rd] |= 0x8000000000000000ULL;
788 vcpu->arch.qpr[ax_rd] = vcpu->arch.qpr[ax_rb];
789 vcpu->arch.qpr[ax_rd] |= 0x80000000;
790 break;
791 case OP_4X_PS_ABS:
792 WARN_ON(rcomp);
793 vcpu->arch.fpr[ax_rd] = vcpu->arch.fpr[ax_rb];
794 vcpu->arch.fpr[ax_rd] &= ~0x8000000000000000ULL;
795 vcpu->arch.qpr[ax_rd] = vcpu->arch.qpr[ax_rb];
796 vcpu->arch.qpr[ax_rd] &= ~0x80000000;
797 break;
798 case OP_4X_PS_MERGE00:
799 WARN_ON(rcomp);
800 vcpu->arch.fpr[ax_rd] = vcpu->arch.fpr[ax_ra];
801 /* vcpu->arch.qpr[ax_rd] = vcpu->arch.fpr[ax_rb]; */
Andreas Schwab49f6be82010-05-31 21:59:13 +0200802 kvm_cvt_df(&vcpu->arch.fpr[ax_rb],
Andreas Schwab05d77ac2010-08-21 11:43:20 +0000803 &vcpu->arch.qpr[ax_rd]);
Alexander Graf831317b2010-02-19 11:00:44 +0100804 break;
805 case OP_4X_PS_MERGE01:
806 WARN_ON(rcomp);
807 vcpu->arch.fpr[ax_rd] = vcpu->arch.fpr[ax_ra];
808 vcpu->arch.qpr[ax_rd] = vcpu->arch.qpr[ax_rb];
809 break;
810 case OP_4X_PS_MERGE10:
811 WARN_ON(rcomp);
812 /* vcpu->arch.fpr[ax_rd] = vcpu->arch.qpr[ax_ra]; */
Andreas Schwab49f6be82010-05-31 21:59:13 +0200813 kvm_cvt_fd(&vcpu->arch.qpr[ax_ra],
Andreas Schwab05d77ac2010-08-21 11:43:20 +0000814 &vcpu->arch.fpr[ax_rd]);
Alexander Graf831317b2010-02-19 11:00:44 +0100815 /* vcpu->arch.qpr[ax_rd] = vcpu->arch.fpr[ax_rb]; */
Andreas Schwab49f6be82010-05-31 21:59:13 +0200816 kvm_cvt_df(&vcpu->arch.fpr[ax_rb],
Andreas Schwab05d77ac2010-08-21 11:43:20 +0000817 &vcpu->arch.qpr[ax_rd]);
Alexander Graf831317b2010-02-19 11:00:44 +0100818 break;
819 case OP_4X_PS_MERGE11:
820 WARN_ON(rcomp);
821 /* vcpu->arch.fpr[ax_rd] = vcpu->arch.qpr[ax_ra]; */
Andreas Schwab49f6be82010-05-31 21:59:13 +0200822 kvm_cvt_fd(&vcpu->arch.qpr[ax_ra],
Andreas Schwab05d77ac2010-08-21 11:43:20 +0000823 &vcpu->arch.fpr[ax_rd]);
Alexander Graf831317b2010-02-19 11:00:44 +0100824 vcpu->arch.qpr[ax_rd] = vcpu->arch.qpr[ax_rb];
825 break;
826 }
827 /* XW form */
828 switch (inst_get_field(inst, 25, 30)) {
829 case OP_4XW_PSQ_STX:
830 {
831 ulong addr = ax_ra ? kvmppc_get_gpr(vcpu, ax_ra) : 0;
832 bool w = inst_get_field(inst, 21, 21) ? true : false;
833 int i = inst_get_field(inst, 22, 24);
834
835 addr += kvmppc_get_gpr(vcpu, ax_rb);
836 emulated = kvmppc_emulate_psq_store(run, vcpu, ax_rd, addr, w, i);
837 break;
838 }
839 case OP_4XW_PSQ_STUX:
840 {
841 ulong addr = kvmppc_get_gpr(vcpu, ax_ra);
842 bool w = inst_get_field(inst, 21, 21) ? true : false;
843 int i = inst_get_field(inst, 22, 24);
844
845 addr += kvmppc_get_gpr(vcpu, ax_rb);
846 emulated = kvmppc_emulate_psq_store(run, vcpu, ax_rd, addr, w, i);
847
848 if (emulated == EMULATE_DONE)
849 kvmppc_set_gpr(vcpu, ax_ra, addr);
850 break;
851 }
852 }
853 /* A form */
854 switch (inst_get_field(inst, 26, 30)) {
855 case OP_4A_PS_SUM1:
856 emulated = kvmppc_ps_two_in(vcpu, rcomp, ax_rd,
857 ax_rb, ax_ra, SCALAR_NO_PS0 | SCALAR_HIGH, fps_fadds);
858 vcpu->arch.fpr[ax_rd] = vcpu->arch.fpr[ax_rc];
859 break;
860 case OP_4A_PS_SUM0:
861 emulated = kvmppc_ps_two_in(vcpu, rcomp, ax_rd,
862 ax_ra, ax_rb, SCALAR_NO_PS1 | SCALAR_LOW, fps_fadds);
863 vcpu->arch.qpr[ax_rd] = vcpu->arch.qpr[ax_rc];
864 break;
865 case OP_4A_PS_MULS0:
866 emulated = kvmppc_ps_two_in(vcpu, rcomp, ax_rd,
867 ax_ra, ax_rc, SCALAR_HIGH, fps_fmuls);
868 break;
869 case OP_4A_PS_MULS1:
870 emulated = kvmppc_ps_two_in(vcpu, rcomp, ax_rd,
871 ax_ra, ax_rc, SCALAR_LOW, fps_fmuls);
872 break;
873 case OP_4A_PS_MADDS0:
874 emulated = kvmppc_ps_three_in(vcpu, rcomp, ax_rd,
875 ax_ra, ax_rc, ax_rb, SCALAR_HIGH, fps_fmadds);
876 break;
877 case OP_4A_PS_MADDS1:
878 emulated = kvmppc_ps_three_in(vcpu, rcomp, ax_rd,
879 ax_ra, ax_rc, ax_rb, SCALAR_LOW, fps_fmadds);
880 break;
881 case OP_4A_PS_DIV:
882 emulated = kvmppc_ps_two_in(vcpu, rcomp, ax_rd,
883 ax_ra, ax_rb, SCALAR_NONE, fps_fdivs);
884 break;
885 case OP_4A_PS_SUB:
886 emulated = kvmppc_ps_two_in(vcpu, rcomp, ax_rd,
887 ax_ra, ax_rb, SCALAR_NONE, fps_fsubs);
888 break;
889 case OP_4A_PS_ADD:
890 emulated = kvmppc_ps_two_in(vcpu, rcomp, ax_rd,
891 ax_ra, ax_rb, SCALAR_NONE, fps_fadds);
892 break;
893 case OP_4A_PS_SEL:
894 emulated = kvmppc_ps_three_in(vcpu, rcomp, ax_rd,
895 ax_ra, ax_rc, ax_rb, SCALAR_NONE, fps_fsel);
896 break;
897 case OP_4A_PS_RES:
898 emulated = kvmppc_ps_one_in(vcpu, rcomp, ax_rd,
899 ax_rb, fps_fres);
900 break;
901 case OP_4A_PS_MUL:
902 emulated = kvmppc_ps_two_in(vcpu, rcomp, ax_rd,
903 ax_ra, ax_rc, SCALAR_NONE, fps_fmuls);
904 break;
905 case OP_4A_PS_RSQRTE:
906 emulated = kvmppc_ps_one_in(vcpu, rcomp, ax_rd,
907 ax_rb, fps_frsqrte);
908 break;
909 case OP_4A_PS_MSUB:
910 emulated = kvmppc_ps_three_in(vcpu, rcomp, ax_rd,
911 ax_ra, ax_rc, ax_rb, SCALAR_NONE, fps_fmsubs);
912 break;
913 case OP_4A_PS_MADD:
914 emulated = kvmppc_ps_three_in(vcpu, rcomp, ax_rd,
915 ax_ra, ax_rc, ax_rb, SCALAR_NONE, fps_fmadds);
916 break;
917 case OP_4A_PS_NMSUB:
918 emulated = kvmppc_ps_three_in(vcpu, rcomp, ax_rd,
919 ax_ra, ax_rc, ax_rb, SCALAR_NONE, fps_fnmsubs);
920 break;
921 case OP_4A_PS_NMADD:
922 emulated = kvmppc_ps_three_in(vcpu, rcomp, ax_rd,
923 ax_ra, ax_rc, ax_rb, SCALAR_NONE, fps_fnmadds);
924 break;
925 }
926 break;
927
928 /* Real FPU operations */
929
930 case OP_LFS:
931 {
932 ulong addr = (ax_ra ? kvmppc_get_gpr(vcpu, ax_ra) : 0) + full_d;
933
934 emulated = kvmppc_emulate_fpr_load(run, vcpu, ax_rd, addr,
935 FPU_LS_SINGLE);
936 break;
937 }
938 case OP_LFSU:
939 {
940 ulong addr = kvmppc_get_gpr(vcpu, ax_ra) + full_d;
941
942 emulated = kvmppc_emulate_fpr_load(run, vcpu, ax_rd, addr,
943 FPU_LS_SINGLE);
944
945 if (emulated == EMULATE_DONE)
946 kvmppc_set_gpr(vcpu, ax_ra, addr);
947 break;
948 }
949 case OP_LFD:
950 {
951 ulong addr = (ax_ra ? kvmppc_get_gpr(vcpu, ax_ra) : 0) + full_d;
952
953 emulated = kvmppc_emulate_fpr_load(run, vcpu, ax_rd, addr,
954 FPU_LS_DOUBLE);
955 break;
956 }
957 case OP_LFDU:
958 {
959 ulong addr = kvmppc_get_gpr(vcpu, ax_ra) + full_d;
960
961 emulated = kvmppc_emulate_fpr_load(run, vcpu, ax_rd, addr,
962 FPU_LS_DOUBLE);
963
964 if (emulated == EMULATE_DONE)
965 kvmppc_set_gpr(vcpu, ax_ra, addr);
966 break;
967 }
968 case OP_STFS:
969 {
970 ulong addr = (ax_ra ? kvmppc_get_gpr(vcpu, ax_ra) : 0) + full_d;
971
972 emulated = kvmppc_emulate_fpr_store(run, vcpu, ax_rd, addr,
973 FPU_LS_SINGLE);
974 break;
975 }
976 case OP_STFSU:
977 {
978 ulong addr = kvmppc_get_gpr(vcpu, ax_ra) + full_d;
979
980 emulated = kvmppc_emulate_fpr_store(run, vcpu, ax_rd, addr,
981 FPU_LS_SINGLE);
982
983 if (emulated == EMULATE_DONE)
984 kvmppc_set_gpr(vcpu, ax_ra, addr);
985 break;
986 }
987 case OP_STFD:
988 {
989 ulong addr = (ax_ra ? kvmppc_get_gpr(vcpu, ax_ra) : 0) + full_d;
990
991 emulated = kvmppc_emulate_fpr_store(run, vcpu, ax_rd, addr,
992 FPU_LS_DOUBLE);
993 break;
994 }
995 case OP_STFDU:
996 {
997 ulong addr = kvmppc_get_gpr(vcpu, ax_ra) + full_d;
998
999 emulated = kvmppc_emulate_fpr_store(run, vcpu, ax_rd, addr,
1000 FPU_LS_DOUBLE);
1001
1002 if (emulated == EMULATE_DONE)
1003 kvmppc_set_gpr(vcpu, ax_ra, addr);
1004 break;
1005 }
1006 case 31:
1007 switch (inst_get_field(inst, 21, 30)) {
1008 case OP_31_LFSX:
1009 {
1010 ulong addr = ax_ra ? kvmppc_get_gpr(vcpu, ax_ra) : 0;
1011
1012 addr += kvmppc_get_gpr(vcpu, ax_rb);
1013 emulated = kvmppc_emulate_fpr_load(run, vcpu, ax_rd,
1014 addr, FPU_LS_SINGLE);
1015 break;
1016 }
1017 case OP_31_LFSUX:
1018 {
1019 ulong addr = kvmppc_get_gpr(vcpu, ax_ra) +
1020 kvmppc_get_gpr(vcpu, ax_rb);
1021
1022 emulated = kvmppc_emulate_fpr_load(run, vcpu, ax_rd,
1023 addr, FPU_LS_SINGLE);
1024
1025 if (emulated == EMULATE_DONE)
1026 kvmppc_set_gpr(vcpu, ax_ra, addr);
1027 break;
1028 }
1029 case OP_31_LFDX:
1030 {
1031 ulong addr = (ax_ra ? kvmppc_get_gpr(vcpu, ax_ra) : 0) +
1032 kvmppc_get_gpr(vcpu, ax_rb);
1033
1034 emulated = kvmppc_emulate_fpr_load(run, vcpu, ax_rd,
1035 addr, FPU_LS_DOUBLE);
1036 break;
1037 }
1038 case OP_31_LFDUX:
1039 {
1040 ulong addr = kvmppc_get_gpr(vcpu, ax_ra) +
1041 kvmppc_get_gpr(vcpu, ax_rb);
1042
1043 emulated = kvmppc_emulate_fpr_load(run, vcpu, ax_rd,
1044 addr, FPU_LS_DOUBLE);
1045
1046 if (emulated == EMULATE_DONE)
1047 kvmppc_set_gpr(vcpu, ax_ra, addr);
1048 break;
1049 }
1050 case OP_31_STFSX:
1051 {
1052 ulong addr = (ax_ra ? kvmppc_get_gpr(vcpu, ax_ra) : 0) +
1053 kvmppc_get_gpr(vcpu, ax_rb);
1054
1055 emulated = kvmppc_emulate_fpr_store(run, vcpu, ax_rd,
1056 addr, FPU_LS_SINGLE);
1057 break;
1058 }
1059 case OP_31_STFSUX:
1060 {
1061 ulong addr = kvmppc_get_gpr(vcpu, ax_ra) +
1062 kvmppc_get_gpr(vcpu, ax_rb);
1063
1064 emulated = kvmppc_emulate_fpr_store(run, vcpu, ax_rd,
1065 addr, FPU_LS_SINGLE);
1066
1067 if (emulated == EMULATE_DONE)
1068 kvmppc_set_gpr(vcpu, ax_ra, addr);
1069 break;
1070 }
1071 case OP_31_STFX:
1072 {
1073 ulong addr = (ax_ra ? kvmppc_get_gpr(vcpu, ax_ra) : 0) +
1074 kvmppc_get_gpr(vcpu, ax_rb);
1075
1076 emulated = kvmppc_emulate_fpr_store(run, vcpu, ax_rd,
1077 addr, FPU_LS_DOUBLE);
1078 break;
1079 }
1080 case OP_31_STFUX:
1081 {
1082 ulong addr = kvmppc_get_gpr(vcpu, ax_ra) +
1083 kvmppc_get_gpr(vcpu, ax_rb);
1084
1085 emulated = kvmppc_emulate_fpr_store(run, vcpu, ax_rd,
1086 addr, FPU_LS_DOUBLE);
1087
1088 if (emulated == EMULATE_DONE)
1089 kvmppc_set_gpr(vcpu, ax_ra, addr);
1090 break;
1091 }
1092 case OP_31_STFIWX:
1093 {
1094 ulong addr = (ax_ra ? kvmppc_get_gpr(vcpu, ax_ra) : 0) +
1095 kvmppc_get_gpr(vcpu, ax_rb);
1096
1097 emulated = kvmppc_emulate_fpr_store(run, vcpu, ax_rd,
1098 addr,
1099 FPU_LS_SINGLE_LOW);
1100 break;
1101 }
1102 break;
1103 }
1104 break;
1105 case 59:
1106 switch (inst_get_field(inst, 21, 30)) {
1107 case OP_59_FADDS:
1108 fpd_fadds(&vcpu->arch.fpscr, &cr, fpr_d, fpr_a, fpr_b);
1109 kvmppc_sync_qpr(vcpu, ax_rd);
1110 break;
1111 case OP_59_FSUBS:
1112 fpd_fsubs(&vcpu->arch.fpscr, &cr, fpr_d, fpr_a, fpr_b);
1113 kvmppc_sync_qpr(vcpu, ax_rd);
1114 break;
1115 case OP_59_FDIVS:
1116 fpd_fdivs(&vcpu->arch.fpscr, &cr, fpr_d, fpr_a, fpr_b);
1117 kvmppc_sync_qpr(vcpu, ax_rd);
1118 break;
1119 case OP_59_FRES:
1120 fpd_fres(&vcpu->arch.fpscr, &cr, fpr_d, fpr_b);
1121 kvmppc_sync_qpr(vcpu, ax_rd);
1122 break;
1123 case OP_59_FRSQRTES:
1124 fpd_frsqrtes(&vcpu->arch.fpscr, &cr, fpr_d, fpr_b);
1125 kvmppc_sync_qpr(vcpu, ax_rd);
1126 break;
1127 }
1128 switch (inst_get_field(inst, 26, 30)) {
1129 case OP_59_FMULS:
1130 fpd_fmuls(&vcpu->arch.fpscr, &cr, fpr_d, fpr_a, fpr_c);
1131 kvmppc_sync_qpr(vcpu, ax_rd);
1132 break;
1133 case OP_59_FMSUBS:
1134 fpd_fmsubs(&vcpu->arch.fpscr, &cr, fpr_d, fpr_a, fpr_c, fpr_b);
1135 kvmppc_sync_qpr(vcpu, ax_rd);
1136 break;
1137 case OP_59_FMADDS:
1138 fpd_fmadds(&vcpu->arch.fpscr, &cr, fpr_d, fpr_a, fpr_c, fpr_b);
1139 kvmppc_sync_qpr(vcpu, ax_rd);
1140 break;
1141 case OP_59_FNMSUBS:
1142 fpd_fnmsubs(&vcpu->arch.fpscr, &cr, fpr_d, fpr_a, fpr_c, fpr_b);
1143 kvmppc_sync_qpr(vcpu, ax_rd);
1144 break;
1145 case OP_59_FNMADDS:
1146 fpd_fnmadds(&vcpu->arch.fpscr, &cr, fpr_d, fpr_a, fpr_c, fpr_b);
1147 kvmppc_sync_qpr(vcpu, ax_rd);
1148 break;
1149 }
1150 break;
1151 case 63:
1152 switch (inst_get_field(inst, 21, 30)) {
1153 case OP_63_MTFSB0:
1154 case OP_63_MTFSB1:
1155 case OP_63_MCRFS:
1156 case OP_63_MTFSFI:
1157 /* XXX need to implement */
1158 break;
1159 case OP_63_MFFS:
1160 /* XXX missing CR */
1161 *fpr_d = vcpu->arch.fpscr;
1162 break;
1163 case OP_63_MTFSF:
1164 /* XXX missing fm bits */
1165 /* XXX missing CR */
1166 vcpu->arch.fpscr = *fpr_b;
1167 break;
1168 case OP_63_FCMPU:
1169 {
1170 u32 tmp_cr;
1171 u32 cr0_mask = 0xf0000000;
1172 u32 cr_shift = inst_get_field(inst, 6, 8) * 4;
1173
1174 fpd_fcmpu(&vcpu->arch.fpscr, &tmp_cr, fpr_a, fpr_b);
1175 cr &= ~(cr0_mask >> cr_shift);
1176 cr |= (cr & cr0_mask) >> cr_shift;
1177 break;
1178 }
1179 case OP_63_FCMPO:
1180 {
1181 u32 tmp_cr;
1182 u32 cr0_mask = 0xf0000000;
1183 u32 cr_shift = inst_get_field(inst, 6, 8) * 4;
1184
1185 fpd_fcmpo(&vcpu->arch.fpscr, &tmp_cr, fpr_a, fpr_b);
1186 cr &= ~(cr0_mask >> cr_shift);
1187 cr |= (cr & cr0_mask) >> cr_shift;
1188 break;
1189 }
1190 case OP_63_FNEG:
1191 fpd_fneg(&vcpu->arch.fpscr, &cr, fpr_d, fpr_b);
1192 break;
1193 case OP_63_FMR:
1194 *fpr_d = *fpr_b;
1195 break;
1196 case OP_63_FABS:
1197 fpd_fabs(&vcpu->arch.fpscr, &cr, fpr_d, fpr_b);
1198 break;
1199 case OP_63_FCPSGN:
1200 fpd_fcpsgn(&vcpu->arch.fpscr, &cr, fpr_d, fpr_a, fpr_b);
1201 break;
1202 case OP_63_FDIV:
1203 fpd_fdiv(&vcpu->arch.fpscr, &cr, fpr_d, fpr_a, fpr_b);
1204 break;
1205 case OP_63_FADD:
1206 fpd_fadd(&vcpu->arch.fpscr, &cr, fpr_d, fpr_a, fpr_b);
1207 break;
1208 case OP_63_FSUB:
1209 fpd_fsub(&vcpu->arch.fpscr, &cr, fpr_d, fpr_a, fpr_b);
1210 break;
1211 case OP_63_FCTIW:
1212 fpd_fctiw(&vcpu->arch.fpscr, &cr, fpr_d, fpr_b);
1213 break;
1214 case OP_63_FCTIWZ:
1215 fpd_fctiwz(&vcpu->arch.fpscr, &cr, fpr_d, fpr_b);
1216 break;
1217 case OP_63_FRSP:
1218 fpd_frsp(&vcpu->arch.fpscr, &cr, fpr_d, fpr_b);
1219 kvmppc_sync_qpr(vcpu, ax_rd);
1220 break;
1221 case OP_63_FRSQRTE:
1222 {
1223 double one = 1.0f;
1224
1225 /* fD = sqrt(fB) */
1226 fpd_fsqrt(&vcpu->arch.fpscr, &cr, fpr_d, fpr_b);
1227 /* fD = 1.0f / fD */
1228 fpd_fdiv(&vcpu->arch.fpscr, &cr, fpr_d, (u64*)&one, fpr_d);
1229 break;
1230 }
1231 }
1232 switch (inst_get_field(inst, 26, 30)) {
1233 case OP_63_FMUL:
1234 fpd_fmul(&vcpu->arch.fpscr, &cr, fpr_d, fpr_a, fpr_c);
1235 break;
1236 case OP_63_FSEL:
1237 fpd_fsel(&vcpu->arch.fpscr, &cr, fpr_d, fpr_a, fpr_c, fpr_b);
1238 break;
1239 case OP_63_FMSUB:
1240 fpd_fmsub(&vcpu->arch.fpscr, &cr, fpr_d, fpr_a, fpr_c, fpr_b);
1241 break;
1242 case OP_63_FMADD:
1243 fpd_fmadd(&vcpu->arch.fpscr, &cr, fpr_d, fpr_a, fpr_c, fpr_b);
1244 break;
1245 case OP_63_FNMSUB:
1246 fpd_fnmsub(&vcpu->arch.fpscr, &cr, fpr_d, fpr_a, fpr_c, fpr_b);
1247 break;
1248 case OP_63_FNMADD:
1249 fpd_fnmadd(&vcpu->arch.fpscr, &cr, fpr_d, fpr_a, fpr_c, fpr_b);
1250 break;
1251 }
1252 break;
1253 }
1254
1255#ifdef DEBUG
1256 for (i = 0; i < ARRAY_SIZE(vcpu->arch.fpr); i++) {
1257 u32 f;
Andreas Schwab05d77ac2010-08-21 11:43:20 +00001258 kvm_cvt_df(&vcpu->arch.fpr[i], &f);
Alexander Graf831317b2010-02-19 11:00:44 +01001259 dprintk(KERN_INFO "FPR[%d] = 0x%x\n", i, f);
1260 }
1261#endif
1262
1263 if (rcomp)
1264 kvmppc_set_cr(vcpu, cr);
1265
1266 preempt_enable();
1267
1268 return emulated;
1269}