1 /* $NetBSD: fpu_emu.c,v 1.14 2005/12/11 12:18:42 christos Exp $ */
4 * Copyright 2001 Wasabi Systems, Inc.
7 * Written by Eduardo Horvath and Simon Burge for Wasabi Systems, Inc.
9 * Redistribution and use in source and binary forms, with or without
10 * modification, are permitted provided that the following conditions
12 * 1. Redistributions of source code must retain the above copyright
13 * notice, this list of conditions and the following disclaimer.
14 * 2. Redistributions in binary form must reproduce the above copyright
15 * notice, this list of conditions and the following disclaimer in the
16 * documentation and/or other materials provided with the distribution.
17 * 3. All advertising materials mentioning features or use of this software
18 * must display the following acknowledgement:
19 * This product includes software developed for the NetBSD Project by
20 * Wasabi Systems, Inc.
21 * 4. The name of Wasabi Systems, Inc. may not be used to endorse
22 * or promote products derived from this software without specific prior
25 * THIS SOFTWARE IS PROVIDED BY WASABI SYSTEMS, INC. ``AS IS'' AND
26 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
27 * TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
28 * PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL WASABI SYSTEMS, INC
29 * BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
30 * CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
31 * SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
32 * INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
33 * CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
34 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
35 * POSSIBILITY OF SUCH DAMAGE.
39 * Copyright (c) 1992, 1993
40 * The Regents of the University of California. All rights reserved.
42 * This software was developed by the Computer Systems Engineering group
43 * at Lawrence Berkeley Laboratory under DARPA contract BG 91-66 and
44 * contributed to Berkeley.
46 * All advertising materials mentioning features or use of this software
47 * must display the following acknowledgement:
48 * This product includes software developed by the University of
49 * California, Lawrence Berkeley Laboratory.
51 * Redistribution and use in source and binary forms, with or without
52 * modification, are permitted provided that the following conditions
54 * 1. Redistributions of source code must retain the above copyright
55 * notice, this list of conditions and the following disclaimer.
56 * 2. Redistributions in binary form must reproduce the above copyright
57 * notice, this list of conditions and the following disclaimer in the
58 * documentation and/or other materials provided with the distribution.
59 * 3. Neither the name of the University nor the names of its contributors
60 * may be used to endorse or promote products derived from this software
61 * without specific prior written permission.
63 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
64 * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
65 * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
66 * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
67 * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
68 * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
69 * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
70 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
71 * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
72 * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
75 * @(#)fpu.c 8.1 (Berkeley) 6/11/93
78 #include <sys/cdefs.h>
79 __FBSDID("$FreeBSD$");
83 #include <sys/param.h>
84 #include <sys/systm.h>
86 #include <sys/kernel.h>
88 #include <sys/sysctl.h>
89 #include <sys/signal.h>
90 #include <sys/syslog.h>
91 #include <sys/signalvar.h>
93 #include <machine/fpu.h>
94 #include <machine/reg.h>
96 #include <powerpc/fpu/fpu_emu.h>
97 #include <powerpc/fpu/fpu_extern.h>
98 #include <powerpc/fpu/fpu_instr.h>
100 static SYSCTL_NODE(_hw, OID_AUTO, fpu_emu, CTLFLAG_RW, 0, "FPU emulator");
102 #define FPU_EMU_EVCNT_DECL(name) \
103 static u_int fpu_emu_evcnt_##name; \
104 SYSCTL_INT(_hw_fpu_emu, OID_AUTO, evcnt_##name, CTLFLAG_RD, \
105 &fpu_emu_evcnt_##name, 0, "")
107 #define FPU_EMU_EVCNT_INCR(name) fpu_emu_evcnt_##name++
109 FPU_EMU_EVCNT_DECL(stfiwx);
110 FPU_EMU_EVCNT_DECL(fpstore);
111 FPU_EMU_EVCNT_DECL(fpload);
112 FPU_EMU_EVCNT_DECL(fcmpu);
113 FPU_EMU_EVCNT_DECL(frsp);
114 FPU_EMU_EVCNT_DECL(fctiw);
115 FPU_EMU_EVCNT_DECL(fcmpo);
116 FPU_EMU_EVCNT_DECL(mtfsb1);
117 FPU_EMU_EVCNT_DECL(fnegabs);
118 FPU_EMU_EVCNT_DECL(mcrfs);
119 FPU_EMU_EVCNT_DECL(mtfsb0);
120 FPU_EMU_EVCNT_DECL(fmr);
121 FPU_EMU_EVCNT_DECL(mtfsfi);
122 FPU_EMU_EVCNT_DECL(fnabs);
123 FPU_EMU_EVCNT_DECL(fabs);
124 FPU_EMU_EVCNT_DECL(mffs);
125 FPU_EMU_EVCNT_DECL(mtfsf);
126 FPU_EMU_EVCNT_DECL(fctid);
127 FPU_EMU_EVCNT_DECL(fcfid);
128 FPU_EMU_EVCNT_DECL(fdiv);
129 FPU_EMU_EVCNT_DECL(fsub);
130 FPU_EMU_EVCNT_DECL(fadd);
131 FPU_EMU_EVCNT_DECL(fsqrt);
132 FPU_EMU_EVCNT_DECL(fsel);
133 FPU_EMU_EVCNT_DECL(fpres);
134 FPU_EMU_EVCNT_DECL(fmul);
135 FPU_EMU_EVCNT_DECL(frsqrte);
136 FPU_EMU_EVCNT_DECL(fmulsub);
137 FPU_EMU_EVCNT_DECL(fmuladd);
138 FPU_EMU_EVCNT_DECL(fnmsub);
139 FPU_EMU_EVCNT_DECL(fnmadd);
141 /* FPSR exception masks */
142 #define FPSR_EX_MSK (FPSCR_VX|FPSCR_OX|FPSCR_UX|FPSCR_ZX| \
143 FPSCR_XX|FPSCR_VXSNAN|FPSCR_VXISI|FPSCR_VXIDI| \
144 FPSCR_VXZDZ|FPSCR_VXIMZ|FPSCR_VXVC|FPSCR_VXSOFT|\
145 FPSCR_VXSQRT|FPSCR_VXCVI)
146 #define FPSR_EX (FPSCR_VE|FPSCR_OE|FPSCR_UE|FPSCR_ZE|FPSCR_XE)
147 #define FPSR_EXOP (FPSR_EX_MSK&(~FPSR_EX))
152 vm_offset_t opc_disasm(vm_offset_t, int);
155 * Dump a `fpn' structure.
158 fpu_dumpfpn(struct fpn *fp)
160 static const char *class[] = {
161 "SNAN", "QNAN", "ZERO", "NUM", "INF"
164 printf("%s %c.%x %x %x %xE%d", class[fp->fp_class + 2],
165 fp->fp_sign ? '-' : ' ',
166 fp->fp_mant[0], fp->fp_mant[1],
167 fp->fp_mant[2], fp->fp_mant[3],
173 * fpu_execute returns the following error numbers (0 = no error):
175 #define FPE 1 /* take a floating point exception */
176 #define NOTFPU 2 /* not an FPU instruction */
181 * Emulate a floating-point instruction.
182 * Return zero for success, else signal number.
183 * (Typically: zero, SIGFPE, SIGILL, SIGSEGV)
186 fpu_emulate(struct trapframe *frame, struct fpreg *fpf)
188 static union instr insn;
189 static struct fpemu fe;
190 static int lastill = 0;
193 /* initialize insn.is_datasize to tell it is *not* initialized */
197 /* always set this (to avoid a warning) */
199 if (copyin((void *) (frame->srr0), &insn.i_int, sizeof (insn.i_int))) {
201 printf("fpu_emulate: fault reading opcode\n");
206 DPRINTF(FPE_EX, ("fpu_emulate: emulating insn %x at %p\n",
207 insn.i_int, (void *)frame->srr0));
210 if ((insn.i_any.i_opcd == OPC_TWI) ||
211 ((insn.i_any.i_opcd == OPC_integer_31) &&
212 (insn.i_x.i_xo == OPC31_TW))) {
213 /* Check for the two trap insns. */
214 DPRINTF(FPE_EX, ("fpu_emulate: SIGTRAP\n"));
218 switch (fpu_execute(frame, &fe, &insn)) {
220 DPRINTF(FPE_EX, ("fpu_emulate: success\n"));
225 DPRINTF(FPE_EX, ("fpu_emulate: SIGFPE\n"));
230 DPRINTF(FPE_EX, ("fpu_emulate: SIGSEGV\n"));
236 DPRINTF(FPE_EX, ("fpu_emulate: SIGILL\n"));
238 if (fpe_debug & FPE_EX) {
239 printf("fpu_emulate: illegal insn %x at %p:",
240 insn.i_int, (void *) (frame->srr0));
241 opc_disasm(frame->srr0, insn.i_int);
245 * XXXX retry an illegal insn once due to cache issues.
247 if (lastill == frame->srr0) {
250 if (fpe_debug & FPE_EX)
251 kdb_enter(KDB_WHY_UNSET, "illegal instruction");
254 lastill = frame->srr0;
262 * Execute an FPU instruction (one that runs entirely in the FPU; not
263 * FBfcc or STF, for instance). On return, fe->fe_fs->fs_fsr will be
264 * modified to reflect the setting the hardware would have left.
266 * Note that we do not catch all illegal opcodes, so you can, for instance,
267 * multiply two integers this way.
270 fpu_execute(struct trapframe *tf, struct fpemu *fe, union instr *insn)
273 union instr instr = *insn;
276 int ra, rb, rc, rt, type, mask, fsr, cx, bf, setcr;
283 fe->fe_fpscr = ((int *)&fs->fpscr)[1];
286 * On PowerPC all floating point values are stored in registers
287 * as doubles, even when used for single precision operations.
290 cond = instr.i_any.i_rc;
292 bf = 0; /* XXX gcc */
294 #if defined(DDB) && defined(DEBUG)
295 if (fpe_debug & FPE_EX) {
296 vm_offset_t loc = tf->srr0;
298 printf("Trying to emulate: %p ", (void *)loc);
299 opc_disasm(loc, instr.i_int);
304 * `Decode' and execute instruction.
307 if ((instr.i_any.i_opcd >= OPC_LFS && instr.i_any.i_opcd <= OPC_STFDU) ||
308 instr.i_any.i_opcd == OPC_integer_31) {
310 * Handle load/store insns:
312 * Convert to/from single if needed, calculate addr,
313 * and update index reg if needed.
316 size_t size = sizeof(float);
319 cond = 0; /* ld/st never set condition codes */
322 if (instr.i_any.i_opcd == OPC_integer_31) {
323 if (instr.i_x.i_xo == OPC31_STFIWX) {
324 FPU_EMU_EVCNT_INCR(stfiwx);
326 /* Store as integer */
330 ("reg %d has %jx reg %d has %jx\n",
331 ra, (uintmax_t)tf->fixreg[ra], rb,
332 (uintmax_t)tf->fixreg[rb]));
334 addr = tf->fixreg[rb];
336 addr += tf->fixreg[ra];
338 a = (int *)&fs->fpreg[rt];
340 ("fpu_execute: Store INT %x at %p\n",
341 a[1], (void *)addr));
342 if (copyout(&a[1], (void *)addr, sizeof(int)))
347 if ((instr.i_x.i_xo & OPC31_FPMASK) != OPC31_FPOP)
348 /* Not an indexed FP load/store op */
351 store = (instr.i_x.i_xo & 0x80);
352 if (instr.i_x.i_xo & 0x40)
353 size = sizeof(double);
356 update = (instr.i_x.i_xo & 0x20);
358 /* calculate EA of load/store */
361 DPRINTF(FPE_INSN, ("reg %d has %jx reg %d has %jx\n",
362 ra, (uintmax_t)tf->fixreg[ra], rb,
363 (uintmax_t)tf->fixreg[rb]));
364 addr = tf->fixreg[rb];
366 addr += tf->fixreg[ra];
369 store = instr.i_d.i_opcd & 0x4;
370 if (instr.i_d.i_opcd & 0x2)
371 size = sizeof(double);
374 update = instr.i_d.i_opcd & 0x1;
376 /* calculate EA of load/store */
378 addr = instr.i_d.i_d;
379 DPRINTF(FPE_INSN, ("reg %d has %jx displ %jx\n",
380 ra, (uintmax_t)tf->fixreg[ra],
383 addr += tf->fixreg[ra];
387 if (update && ra == 0)
392 FPU_EMU_EVCNT_INCR(fpstore);
393 if (type != FTYPE_DBL) {
395 ("fpu_execute: Store SNG at %p\n",
397 fpu_explode(fe, fp = &fe->fe_f1, FTYPE_DBL, rt);
398 fpu_implode(fe, fp, type, (void *)&buf);
399 if (copyout(&buf, (void *)addr, size))
403 ("fpu_execute: Store DBL at %p\n",
405 if (copyout(&fs->fpreg[rt], (void *)addr, size))
410 FPU_EMU_EVCNT_INCR(fpload);
411 DPRINTF(FPE_INSN, ("fpu_execute: Load from %p\n",
413 if (copyin((const void *)addr, &fs->fpreg[rt], size))
415 if (type != FTYPE_DBL) {
416 fpu_explode(fe, fp = &fe->fe_f1, type, rt);
417 fpu_implode(fe, fp, FTYPE_DBL,
418 (u_int *)&fs->fpreg[rt]);
422 tf->fixreg[ra] = addr;
426 } else if (instr.i_any.i_opcd == OPC_load_st_62) {
427 /* These are 64-bit extensions */
430 } else if (instr.i_any.i_opcd == OPC_sp_fp_59 ||
431 instr.i_any.i_opcd == OPC_dp_fp_63) {
434 if (instr.i_any.i_opcd == OPC_dp_fp_63 &&
435 !(instr.i_a.i_xo & OPC63M_MASK)) {
442 /* One of the special opcodes.... */
443 switch (instr.i_x.i_xo) {
445 FPU_EMU_EVCNT_INCR(fcmpu);
446 DPRINTF(FPE_INSN, ("fpu_execute: FCMPU\n"));
448 fpu_explode(fe, &fe->fe_f1, type, ra);
449 fpu_explode(fe, &fe->fe_f2, type, rb);
451 /* Make sure we do the condition regs. */
453 /* N.B.: i_rs is already left shifted by two. */
454 bf = instr.i_x.i_rs & 0xfc;
462 * PowerPC uses this to round a double
463 * precision value to single precision,
464 * but values in registers are always
465 * stored in double precision format.
467 FPU_EMU_EVCNT_INCR(frsp);
468 DPRINTF(FPE_INSN, ("fpu_execute: FRSP\n"));
469 fpu_explode(fe, fp = &fe->fe_f1, FTYPE_DBL, rb);
470 fpu_implode(fe, fp, FTYPE_SNG,
471 (u_int *)&fs->fpreg[rt]);
472 fpu_explode(fe, fp = &fe->fe_f1, FTYPE_SNG, rt);
477 FPU_EMU_EVCNT_INCR(fctiw);
478 DPRINTF(FPE_INSN, ("fpu_execute: FCTIW\n"));
479 fpu_explode(fe, fp = &fe->fe_f1, type, rb);
483 FPU_EMU_EVCNT_INCR(fcmpo);
484 DPRINTF(FPE_INSN, ("fpu_execute: FCMPO\n"));
486 fpu_explode(fe, &fe->fe_f1, type, ra);
487 fpu_explode(fe, &fe->fe_f2, type, rb);
489 /* Make sure we do the condition regs. */
491 /* N.B.: i_rs is already left shifted by two. */
492 bf = instr.i_x.i_rs & 0xfc;
496 FPU_EMU_EVCNT_INCR(mtfsb1);
497 DPRINTF(FPE_INSN, ("fpu_execute: MTFSB1\n"));
499 (~(FPSCR_VX|FPSR_EX) & (1<<(31-rt)));
502 FPU_EMU_EVCNT_INCR(fnegabs);
503 DPRINTF(FPE_INSN, ("fpu_execute: FNEGABS\n"));
504 memcpy(&fs->fpreg[rt], &fs->fpreg[rb],
506 a = (int *)&fs->fpreg[rt];
510 FPU_EMU_EVCNT_INCR(mcrfs);
511 DPRINTF(FPE_INSN, ("fpu_execute: MCRFS\n"));
515 /* Extract the bits we want */
516 mask = (fe->fe_fpscr >> (28 - ra)) & 0xf;
517 /* Clear the bits we copied. */
519 (FPSR_EX_MSK | (0xf << (28 - ra)));
520 fe->fe_fpscr &= fe->fe_cx;
521 /* Now shove them in the right part of cr */
522 tf->cr &= ~(0xf << (28 - rt));
523 tf->cr |= (mask << (28 - rt));
526 FPU_EMU_EVCNT_INCR(mtfsb0);
527 DPRINTF(FPE_INSN, ("fpu_execute: MTFSB0\n"));
529 ((FPSCR_VX|FPSR_EX) & ~(1<<(31-rt)));
532 FPU_EMU_EVCNT_INCR(fmr);
533 DPRINTF(FPE_INSN, ("fpu_execute: FMR\n"));
534 memcpy(&fs->fpreg[rt], &fs->fpreg[rb],
538 FPU_EMU_EVCNT_INCR(mtfsfi);
539 DPRINTF(FPE_INSN, ("fpu_execute: MTFSFI\n"));
541 rt &= 0x1c; /* Already left-shifted 4 */
542 fe->fe_cx = rb << (28 - rt);
543 mask = 0xf<<(28 - rt);
544 fe->fe_fpscr = (fe->fe_fpscr & ~mask) |
546 /* XXX weird stuff about OX, FX, FEX, and VX should be handled */
549 FPU_EMU_EVCNT_INCR(fnabs);
550 DPRINTF(FPE_INSN, ("fpu_execute: FABS\n"));
551 memcpy(&fs->fpreg[rt], &fs->fpreg[rb],
553 a = (int *)&fs->fpreg[rt];
557 FPU_EMU_EVCNT_INCR(fabs);
558 DPRINTF(FPE_INSN, ("fpu_execute: FABS\n"));
559 memcpy(&fs->fpreg[rt], &fs->fpreg[rb],
561 a = (int *)&fs->fpreg[rt];
565 FPU_EMU_EVCNT_INCR(mffs);
566 DPRINTF(FPE_INSN, ("fpu_execute: MFFS\n"));
567 memcpy(&fs->fpreg[rt], &fs->fpscr,
571 FPU_EMU_EVCNT_INCR(mtfsf);
572 DPRINTF(FPE_INSN, ("fpu_execute: MTFSF\n"));
573 if ((rt = instr.i_xfl.i_flm) == -1)
577 /* Convert 1 bit -> 4 bits */
578 for (ra = 0; ra < 8; ra ++)
580 mask |= (0xf<<(4*ra));
582 a = (int *)&fs->fpreg[rt];
583 fe->fe_cx = mask & a[1];
584 fe->fe_fpscr = (fe->fe_fpscr&~mask) |
586 /* XXX weird stuff about OX, FX, FEX, and VX should be handled */
590 FPU_EMU_EVCNT_INCR(fctid);
591 DPRINTF(FPE_INSN, ("fpu_execute: FCTID\n"));
592 fpu_explode(fe, fp = &fe->fe_f1, type, rb);
596 FPU_EMU_EVCNT_INCR(fcfid);
597 DPRINTF(FPE_INSN, ("fpu_execute: FCFID\n"));
599 fpu_explode(fe, fp = &fe->fe_f1, type, rb);
608 rt = instr.i_a.i_frt;
609 ra = instr.i_a.i_fra;
610 rb = instr.i_a.i_frb;
611 rc = instr.i_a.i_frc;
614 * All arithmetic operations work on registers, which
615 * are stored as doubles.
618 switch ((unsigned int)instr.i_a.i_xo) {
620 FPU_EMU_EVCNT_INCR(fdiv);
621 DPRINTF(FPE_INSN, ("fpu_execute: FDIV\n"));
622 fpu_explode(fe, &fe->fe_f1, type, ra);
623 fpu_explode(fe, &fe->fe_f2, type, rb);
627 FPU_EMU_EVCNT_INCR(fsub);
628 DPRINTF(FPE_INSN, ("fpu_execute: FSUB\n"));
629 fpu_explode(fe, &fe->fe_f1, type, ra);
630 fpu_explode(fe, &fe->fe_f2, type, rb);
634 FPU_EMU_EVCNT_INCR(fadd);
635 DPRINTF(FPE_INSN, ("fpu_execute: FADD\n"));
636 fpu_explode(fe, &fe->fe_f1, type, ra);
637 fpu_explode(fe, &fe->fe_f2, type, rb);
641 FPU_EMU_EVCNT_INCR(fsqrt);
642 DPRINTF(FPE_INSN, ("fpu_execute: FSQRT\n"));
643 fpu_explode(fe, &fe->fe_f1, type, rb);
647 FPU_EMU_EVCNT_INCR(fsel);
648 DPRINTF(FPE_INSN, ("fpu_execute: FSEL\n"));
649 a = (int *)&fe->fe_fpstate->fpreg[ra];
650 if ((*a & 0x80000000) && (*a & 0x7fffffff))
653 DPRINTF(FPE_INSN, ("f%d => f%d\n", rc, rt));
654 memcpy(&fs->fpreg[rt], &fs->fpreg[rc],
658 FPU_EMU_EVCNT_INCR(fpres);
659 DPRINTF(FPE_INSN, ("fpu_execute: FPRES\n"));
660 fpu_explode(fe, &fe->fe_f1, type, rb);
662 /* now we've gotta overwrite the dest reg */
663 *((int *)&fe->fe_fpstate->fpreg[rt]) = 1;
664 fpu_explode(fe, &fe->fe_f1, FTYPE_INT, rt);
668 FPU_EMU_EVCNT_INCR(fmul);
669 DPRINTF(FPE_INSN, ("fpu_execute: FMUL\n"));
670 fpu_explode(fe, &fe->fe_f1, type, ra);
671 fpu_explode(fe, &fe->fe_f2, type, rc);
675 /* Reciprocal sqrt() estimate */
676 FPU_EMU_EVCNT_INCR(frsqrte);
677 DPRINTF(FPE_INSN, ("fpu_execute: FRSQRTE\n"));
678 fpu_explode(fe, &fe->fe_f1, type, rb);
681 /* now we've gotta overwrite the dest reg */
682 *((int *)&fe->fe_fpstate->fpreg[rt]) = 1;
683 fpu_explode(fe, &fe->fe_f1, FTYPE_INT, rt);
687 FPU_EMU_EVCNT_INCR(fmulsub);
688 DPRINTF(FPE_INSN, ("fpu_execute: FMULSUB\n"));
689 fpu_explode(fe, &fe->fe_f1, type, ra);
690 fpu_explode(fe, &fe->fe_f2, type, rc);
693 fpu_explode(fe, &fe->fe_f2, type, rb);
697 FPU_EMU_EVCNT_INCR(fmuladd);
698 DPRINTF(FPE_INSN, ("fpu_execute: FMULADD\n"));
699 fpu_explode(fe, &fe->fe_f1, type, ra);
700 fpu_explode(fe, &fe->fe_f2, type, rc);
703 fpu_explode(fe, &fe->fe_f2, type, rb);
707 FPU_EMU_EVCNT_INCR(fnmsub);
708 DPRINTF(FPE_INSN, ("fpu_execute: FNMSUB\n"));
709 fpu_explode(fe, &fe->fe_f1, type, ra);
710 fpu_explode(fe, &fe->fe_f2, type, rc);
713 fpu_explode(fe, &fe->fe_f2, type, rb);
719 FPU_EMU_EVCNT_INCR(fnmadd);
720 DPRINTF(FPE_INSN, ("fpu_execute: FNMADD\n"));
721 fpu_explode(fe, &fe->fe_f1, type, ra);
722 fpu_explode(fe, &fe->fe_f2, type, rc);
725 fpu_explode(fe, &fe->fe_f2, type, rb);
735 /* If the instruction was single precision, round */
736 if (!(instr.i_any.i_opcd & 0x4)) {
737 fpu_implode(fe, fp, FTYPE_SNG,
738 (u_int *)&fs->fpreg[rt]);
739 fpu_explode(fe, fp = &fe->fe_f1, FTYPE_SNG, rt);
747 * ALU operation is complete. Collapse the result and then check
748 * for exceptions. If we got any, and they are enabled, do not
749 * alter the destination register, just stop with an exception.
750 * Otherwise set new current exceptions and accrue.
753 fpu_implode(fe, fp, type, (u_int *)&fs->fpreg[rt]);
758 if ((cx^fsr)&FPSR_EX_MSK)
760 mask = fsr & FPSR_EX;
764 if (cx & FPSCR_FPRF) {
765 /* Need to replace CC */
768 if (cx & (FPSR_EXOP))
771 DPRINTF(FPE_INSN, ("fpu_execute: cx %x, fsr %x\n", cx, fsr));
775 cond = fsr & 0xf0000000;
776 /* Isolate condition codes */
778 /* Move fpu condition codes to cr[1] */
779 tf->cr &= (0x0f000000);
780 tf->cr |= (cond<<24);
781 DPRINTF(FPE_INSN, ("fpu_execute: cr[1] <= %x\n", cond));
785 cond = fsr & FPSCR_FPCC;
786 /* Isolate condition codes */
788 /* Move fpu condition codes to cr[1] */
789 tf->cr &= ~(0xf0000000>>bf);
790 tf->cr |= (cond>>bf);
791 DPRINTF(FPE_INSN, ("fpu_execute: cr[%d] (cr=%jx) <= %x\n",
792 bf/4, (uintmax_t)tf->cr, cond));
795 ((int *)&fs->fpscr)[1] = fsr;
798 return (0); /* success */