1*8c2f80f1Spgoyette /* $NetBSD: fpu.c,v 1.29 2019/03/01 11:06:55 pgoyette Exp $ */
2274a9076Sderaadt
34588caefSderaadt /*
44588caefSderaadt * Copyright (c) 1992, 1993
54588caefSderaadt * The Regents of the University of California. All rights reserved.
64588caefSderaadt *
74588caefSderaadt * This software was developed by the Computer Systems Engineering group
84588caefSderaadt * at Lawrence Berkeley Laboratory under DARPA contract BG 91-66 and
94588caefSderaadt * contributed to Berkeley.
104588caefSderaadt *
114588caefSderaadt * All advertising materials mentioning features or use of this software
124588caefSderaadt * must display the following acknowledgement:
134588caefSderaadt * This product includes software developed by the University of
144588caefSderaadt * California, Lawrence Berkeley Laboratory.
154588caefSderaadt *
164588caefSderaadt * Redistribution and use in source and binary forms, with or without
174588caefSderaadt * modification, are permitted provided that the following conditions
184588caefSderaadt * are met:
194588caefSderaadt * 1. Redistributions of source code must retain the above copyright
204588caefSderaadt * notice, this list of conditions and the following disclaimer.
214588caefSderaadt * 2. Redistributions in binary form must reproduce the above copyright
224588caefSderaadt * notice, this list of conditions and the following disclaimer in the
234588caefSderaadt * documentation and/or other materials provided with the distribution.
24aad01611Sagc * 3. Neither the name of the University nor the names of its contributors
254588caefSderaadt * may be used to endorse or promote products derived from this software
264588caefSderaadt * without specific prior written permission.
274588caefSderaadt *
284588caefSderaadt * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
294588caefSderaadt * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
304588caefSderaadt * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
314588caefSderaadt * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
324588caefSderaadt * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
334588caefSderaadt * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
344588caefSderaadt * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
354588caefSderaadt * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
364588caefSderaadt * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
374588caefSderaadt * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
384588caefSderaadt * SUCH DAMAGE.
394588caefSderaadt *
404588caefSderaadt * @(#)fpu.c 8.1 (Berkeley) 6/11/93
414588caefSderaadt */
424588caefSderaadt
43a4183603Slukem #include <sys/cdefs.h>
44*8c2f80f1Spgoyette __KERNEL_RCSID(0, "$NetBSD: fpu.c,v 1.29 2019/03/01 11:06:55 pgoyette Exp $");
45a4183603Slukem
464588caefSderaadt #include <sys/param.h>
474588caefSderaadt #include <sys/proc.h>
484588caefSderaadt #include <sys/signal.h>
494588caefSderaadt #include <sys/systm.h>
504588caefSderaadt #include <sys/syslog.h>
51ab59f984Schristos #include <sys/signalvar.h>
52d91f98a8Spgoyette #include <sys/compat_stub.h>
534588caefSderaadt
544588caefSderaadt #include <machine/instr.h>
554588caefSderaadt #include <machine/reg.h>
564588caefSderaadt
574588caefSderaadt #include <sparc/fpu/fpu_emu.h>
58ab59f984Schristos #include <sparc/fpu/fpu_extern.h>
594588caefSderaadt
60dd5c54d0Seeh int fpe_debug = 0;
61dd5c54d0Seeh
62dd5c54d0Seeh #ifdef DEBUG
63dd5c54d0Seeh /*
64dd5c54d0Seeh * Dump a `fpn' structure.
65dd5c54d0Seeh */
66dd5c54d0Seeh void
fpu_dumpfpn(struct fpn * fp)67dd5c54d0Seeh fpu_dumpfpn(struct fpn *fp)
68dd5c54d0Seeh {
69f69f7eeaSchristos static const char *class[] = {
70dd5c54d0Seeh "SNAN", "QNAN", "ZERO", "NUM", "INF"
71dd5c54d0Seeh };
72dd5c54d0Seeh
73dd5c54d0Seeh printf("%s %c.%x %x %x %xE%d", class[fp->fp_class + 2],
74dd5c54d0Seeh fp->fp_sign ? '-' : ' ',
75dd5c54d0Seeh fp->fp_mant[0], fp->fp_mant[1],
76dd5c54d0Seeh fp->fp_mant[2], fp->fp_mant[3],
77dd5c54d0Seeh fp->fp_exp);
78dd5c54d0Seeh }
79dd5c54d0Seeh #endif
80dd5c54d0Seeh
814588caefSderaadt /*
824588caefSderaadt * fpu_execute returns the following error numbers (0 = no error):
834588caefSderaadt */
844588caefSderaadt #define FPE 1 /* take a floating point exception */
854588caefSderaadt #define NOTFPU 2 /* not an FPU instruction */
864588caefSderaadt
874588caefSderaadt /*
884588caefSderaadt * Translate current exceptions into `first' exception. The
894588caefSderaadt * bits go the wrong way for ffs() (0x10 is most important, etc).
904588caefSderaadt * There are only 5, so do it the obvious way.
914588caefSderaadt */
924588caefSderaadt #define X1(x) x
934588caefSderaadt #define X2(x) x,x
944588caefSderaadt #define X4(x) x,x,x,x
954588caefSderaadt #define X8(x) X4(x),X4(x)
964588caefSderaadt #define X16(x) X8(x),X8(x)
974588caefSderaadt
984588caefSderaadt static char cx_to_trapx[] = {
994588caefSderaadt X1(FSR_NX),
1004588caefSderaadt X2(FSR_DZ),
1014588caefSderaadt X4(FSR_UF),
1024588caefSderaadt X8(FSR_OF),
1034588caefSderaadt X16(FSR_NV)
1044588caefSderaadt };
105a9b14e04Spk static u_char fpu_codes_native[] = {
106a9b14e04Spk X1(FPE_FLTRES),
107a9b14e04Spk X2(FPE_FLTDIV),
108a9b14e04Spk X4(FPE_FLTUND),
109a9b14e04Spk X8(FPE_FLTOVF),
110a9b14e04Spk X16(FPE_FLTINV)
111a9b14e04Spk };
1123de506eaSpk static u_char fpu_codes_sunos[] = {
1134588caefSderaadt X1(FPE_FLTINEX_TRAP),
1144588caefSderaadt X2(FPE_FLTDIV_TRAP),
1154588caefSderaadt X4(FPE_FLTUND_TRAP),
1164588caefSderaadt X8(FPE_FLTOVF_TRAP),
1174588caefSderaadt X16(FPE_FLTOPERR_TRAP)
1184588caefSderaadt };
119d91f98a8Spgoyette
1203de506eaSpk /* Note: SVR4(Solaris) FPE_* codes happen to be compatible with ours */
1214588caefSderaadt
1224588caefSderaadt /*
1234588caefSderaadt * The FPU gave us an exception. Clean up the mess. Note that the
1244588caefSderaadt * fp queue can only have FPops in it, never load/store FP registers
1254588caefSderaadt * nor FBfcc instructions. Experiments with `crashme' prove that
1264588caefSderaadt * unknown FPops do enter the queue, however.
1274588caefSderaadt */
12846166f9bSpk int
fpu_cleanup(struct lwp * l,struct fpstate * fs)1291d7f24eaSmatt fpu_cleanup(
1301d7f24eaSmatt struct lwp *l,
131feddb7adSmrg #ifndef SUN4U
1321d7f24eaSmatt struct fpstate *fs
133feddb7adSmrg #else /* SUN4U */
1341d7f24eaSmatt struct fpstate64 *fs
135feddb7adSmrg #endif /* SUN4U */
1361d7f24eaSmatt )
1374588caefSderaadt {
138a9b14e04Spk int i, fsr = fs->fs_fsr, error;
139c464d72fSthorpej struct proc *p = l->l_proc;
1404588caefSderaadt union instr instr;
1414588caefSderaadt struct fpemu fe;
142a9b14e04Spk u_char *fpu_codes;
14346166f9bSpk int code = 0;
144d91f98a8Spgoyette int ret;
145d91f98a8Spgoyette const struct emul *sunos_emul;
146a9b14e04Spk
147*8c2f80f1Spgoyette MODULE_HOOK_CALL(get_emul_sunos_hook, (&sunos_emul), enosys(), ret);
148d91f98a8Spgoyette
149d91f98a8Spgoyette if (ret == 0 && p->p_emul == sunos_emul)
150d91f98a8Spgoyette fpu_codes = fpu_codes_sunos;
151d91f98a8Spgoyette else
152d91f98a8Spgoyette fpu_codes = fpu_codes_native;
1534588caefSderaadt
1544588caefSderaadt switch ((fsr >> FSR_FTT_SHIFT) & FSR_FTT_MASK) {
1554588caefSderaadt
1564588caefSderaadt case FSR_TT_NONE:
157feddb7adSmrg panic("fpu_cleanup: No fault"); /* ??? */
1584588caefSderaadt break;
1594588caefSderaadt
1604588caefSderaadt case FSR_TT_IEEE:
161112afe4fSeeh DPRINTF(FPE_INSN, ("fpu_cleanup: FSR_TT_IEEE\n"));
1624588caefSderaadt /* XXX missing trap address! */
1634588caefSderaadt if ((i = fsr & FSR_CX) == 0)
1644588caefSderaadt panic("fpu ieee trap, but no exception");
16546166f9bSpk code = fpu_codes[i - 1];
1664588caefSderaadt break; /* XXX should return, but queue remains */
1674588caefSderaadt
1684588caefSderaadt case FSR_TT_UNFIN:
169112afe4fSeeh DPRINTF(FPE_INSN, ("fpu_cleanup: FSR_TT_UNFIN\n"));
170feddb7adSmrg #ifdef SUN4U
171feddb7adSmrg if (fs->fs_qsize == 0) {
172feddb7adSmrg printf("fpu_cleanup: unfinished fpop");
173feddb7adSmrg /* The book sez reexecute or emulate. */
17446166f9bSpk return (0);
175feddb7adSmrg }
176feddb7adSmrg break;
177feddb7adSmrg
178feddb7adSmrg #endif /* SUN4U */
1794588caefSderaadt case FSR_TT_UNIMP:
180112afe4fSeeh DPRINTF(FPE_INSN, ("fpu_cleanup: FSR_TT_UNIMP\n"));
1814588caefSderaadt if (fs->fs_qsize == 0)
182feddb7adSmrg panic("fpu_cleanup: unimplemented fpop");
1834588caefSderaadt break;
1844588caefSderaadt
1854588caefSderaadt case FSR_TT_SEQ:
1864588caefSderaadt panic("fpu sequence error");
1874588caefSderaadt /* NOTREACHED */
1884588caefSderaadt
1894588caefSderaadt case FSR_TT_HWERR:
190112afe4fSeeh DPRINTF(FPE_INSN, ("fpu_cleanup: FSR_TT_HWERR\n"));
1914588caefSderaadt log(LOG_ERR, "fpu hardware error (%s[%d])\n",
1924588caefSderaadt p->p_comm, p->p_pid);
1934588caefSderaadt uprintf("%s[%d]: fpu hardware error\n", p->p_comm, p->p_pid);
19446166f9bSpk code = SI_NOINFO;
1954588caefSderaadt goto out;
1964588caefSderaadt
1974588caefSderaadt default:
198d074ca9fSfair printf("fsr=0x%x\n", fsr);
1994588caefSderaadt panic("fpu error");
2004588caefSderaadt }
2014588caefSderaadt
2024588caefSderaadt /* emulate the instructions left in the queue */
2034588caefSderaadt fe.fe_fpstate = fs;
2044588caefSderaadt for (i = 0; i < fs->fs_qsize; i++) {
2054588caefSderaadt instr.i_int = fs->fs_queue[i].fq_instr;
2064588caefSderaadt if (instr.i_any.i_op != IOP_reg ||
2074588caefSderaadt (instr.i_op3.i_op3 != IOP3_FPop1 &&
2084588caefSderaadt instr.i_op3.i_op3 != IOP3_FPop2))
2094588caefSderaadt panic("bogus fpu queue");
2104588caefSderaadt error = fpu_execute(&fe, instr);
2110a66c7efSpk if (error == 0)
2124588caefSderaadt continue;
2134588caefSderaadt
2140a66c7efSpk switch (error) {
2154588caefSderaadt case FPE:
21646166f9bSpk code = fpu_codes[(fs->fs_fsr & FSR_CX) - 1];
2174588caefSderaadt break;
2184588caefSderaadt
2194588caefSderaadt case NOTFPU:
220feddb7adSmrg #ifdef SUN4U
221feddb7adSmrg #ifdef DEBUG
222703ec39aSmrg printf("fpu_cleanup: not an FPU error -- sending SIGILL\n");
223feddb7adSmrg #endif
224feddb7adSmrg #endif /* SUN4U */
22546166f9bSpk code = SI_NOINFO;
2264588caefSderaadt break;
2274588caefSderaadt
2284588caefSderaadt default:
2294588caefSderaadt panic("fpu_cleanup 3");
2304588caefSderaadt /* NOTREACHED */
2314588caefSderaadt }
2324588caefSderaadt /* XXX should stop here, but queue remains */
2334588caefSderaadt }
2344588caefSderaadt out:
2354588caefSderaadt fs->fs_qsize = 0;
23646166f9bSpk return (code);
2374588caefSderaadt }
2384588caefSderaadt
2394588caefSderaadt #ifdef notyet
2404588caefSderaadt /*
2414588caefSderaadt * If we have no FPU at all (are there any machines like this out
2424588caefSderaadt * there!?) we have to emulate each instruction, and we need a pointer
2434588caefSderaadt * to the trapframe so that we can step over them and do FBfcc's.
2444588caefSderaadt * We know the `queue' is empty, though; we just want to emulate
2454588caefSderaadt * the instruction at tf->tf_pc.
2464588caefSderaadt */
247c464d72fSthorpej fpu_emulate(l, tf, fs)
248c464d72fSthorpej struct lwp *l;
249a9b14e04Spk struct trapframe *tf;
250feddb7adSmrg #ifndef SUN4U
251a9b14e04Spk struct fpstate *fs;
252feddb7adSmrg #else /* SUN4U */
253a9b14e04Spk struct fpstate64 *fs;
254feddb7adSmrg #endif /* SUN4U */
2554588caefSderaadt {
2564588caefSderaadt
2574588caefSderaadt do {
2584588caefSderaadt fetch instr from pc
2594588caefSderaadt decode
2604588caefSderaadt if (integer instr) {
261a626cff9Srmind struct pcb *pcb = lwp_getpcb(l);
2624588caefSderaadt /*
2634588caefSderaadt * We do this here, rather than earlier, to avoid
2644588caefSderaadt * losing even more badly than usual.
2654588caefSderaadt */
266a626cff9Srmind if (pcb->pcb_uw) {
2674588caefSderaadt write_user_windows();
268c464d72fSthorpej if (rwindow_save(l))
269c464d72fSthorpej sigexit(l, SIGILL);
2704588caefSderaadt }
2714588caefSderaadt if (loadstore) {
2724588caefSderaadt do_it;
2734588caefSderaadt pc = npc, npc += 4
2744588caefSderaadt } else if (fbfcc) {
2754588caefSderaadt do_annul_stuff;
2764588caefSderaadt } else
2774588caefSderaadt return;
2784588caefSderaadt } else if (fpu instr) {
2794588caefSderaadt fe.fe_fsr = fs->fs_fsr &= ~FSR_CX;
2804588caefSderaadt error = fpu_execute(&fe, fs, instr);
2814588caefSderaadt switch (error) {
2824588caefSderaadt etc;
2834588caefSderaadt }
2844588caefSderaadt } else
2854588caefSderaadt return;
2864588caefSderaadt if (want to reschedule)
2874588caefSderaadt return;
2884588caefSderaadt } while (error == 0);
2894588caefSderaadt }
2904588caefSderaadt #endif
2914588caefSderaadt
2924588caefSderaadt /*
2934588caefSderaadt * Execute an FPU instruction (one that runs entirely in the FPU; not
2944588caefSderaadt * FBfcc or STF, for instance). On return, fe->fe_fs->fs_fsr will be
2954588caefSderaadt * modified to reflect the setting the hardware would have left.
2964588caefSderaadt *
2974588caefSderaadt * Note that we do not catch all illegal opcodes, so you can, for instance,
2984588caefSderaadt * multiply two integers this way.
2994588caefSderaadt */
3004588caefSderaadt int
fpu_execute(struct fpemu * fe,union instr instr)3018247051eSuwe fpu_execute(struct fpemu *fe, union instr instr)
3024588caefSderaadt {
303a9b14e04Spk struct fpn *fp;
304feddb7adSmrg #ifndef SUN4U
305a9b14e04Spk int opf, rs1, rs2, rd, type, mask, fsr, cx;
306a9b14e04Spk struct fpstate *fs;
307feddb7adSmrg #else /* SUN4U */
308a9b14e04Spk int opf, rs1, rs2, rd, type, mask, fsr, cx, i, cond;
309a9b14e04Spk struct fpstate64 *fs;
310feddb7adSmrg #endif /* SUN4U */
3114588caefSderaadt u_int space[4];
3124588caefSderaadt
3134588caefSderaadt /*
3144588caefSderaadt * `Decode' and execute instruction. Start with no exceptions.
3154588caefSderaadt * The type of any i_opf opcode is in the bottom two bits, so we
3164588caefSderaadt * squish them out here.
3174588caefSderaadt */
3184588caefSderaadt opf = instr.i_opf.i_opf;
319ebe55962Seeh /*
320ebe55962Seeh * The low two bits of the opf field for floating point insns usually
321ebe55962Seeh * correspond to the operation width:
322ebe55962Seeh *
323ebe55962Seeh * 0: Invalid
324ebe55962Seeh * 1: Single precision float
325ebe55962Seeh * 2: Double precision float
326ebe55962Seeh * 3: Quad precision float
327ebe55962Seeh *
328ebe55962Seeh * The exceptions are the integer to float conversion instructions.
329ebe55962Seeh *
330ebe55962Seeh * For double and quad precision, the low bit if the rs or rd field
331ebe55962Seeh * is actually the high bit of the register number.
332ebe55962Seeh */
333ebe55962Seeh
3344588caefSderaadt type = opf & 3;
335ebe55962Seeh mask = 0x3 >> (3 - type);
336ebe55962Seeh
337ebe55962Seeh rs1 = instr.i_opf.i_rs1;
338ebe55962Seeh rs1 = (rs1 & ~mask) | ((rs1 & mask & 0x1) << 5);
339ebe55962Seeh rs2 = instr.i_opf.i_rs2;
340ebe55962Seeh rs2 = (rs2 & ~mask) | ((rs2 & mask & 0x1) << 5);
341ebe55962Seeh rd = instr.i_opf.i_rd;
342ebe55962Seeh rd = (rd & ~mask) | ((rd & mask & 0x1) << 5);
343ebe55962Seeh #ifdef DIAGNOSTIC
3444588caefSderaadt if ((rs1 | rs2 | rd) & mask)
34540614230Seeh /* This may be an FPU insn but it is illegal. */
34640614230Seeh return (NOTFPU);
3474588caefSderaadt #endif
3484588caefSderaadt fs = fe->fe_fpstate;
3494588caefSderaadt fe->fe_fsr = fs->fs_fsr & ~FSR_CX;
3504588caefSderaadt fe->fe_cx = 0;
351feddb7adSmrg #ifdef SUN4U
352feddb7adSmrg /*
353feddb7adSmrg * Check to see if we're dealing with a fancy cmove and handle
354feddb7adSmrg * it first.
355feddb7adSmrg */
356feddb7adSmrg if (instr.i_op3.i_op3 == IOP3_FPop2 && (opf&0xff0) != (FCMP&0xff0)) {
357feddb7adSmrg switch (opf >>= 2) {
358feddb7adSmrg case FMVFC0 >> 2:
359dd5c54d0Seeh DPRINTF(FPE_INSN, ("fpu_execute: FMVFC0\n"));
360feddb7adSmrg cond = (fs->fs_fsr>>FSR_FCC_SHIFT)&FSR_FCC_MASK;
361feddb7adSmrg if (instr.i_fmovcc.i_cond != cond) return(0); /* success */
362feddb7adSmrg rs1 = fs->fs_regs[rs2];
363feddb7adSmrg goto mov;
364feddb7adSmrg case FMVFC1 >> 2:
365dd5c54d0Seeh DPRINTF(FPE_INSN, ("fpu_execute: FMVFC1\n"));
366feddb7adSmrg cond = (fs->fs_fsr>>FSR_FCC1_SHIFT)&FSR_FCC_MASK;
367feddb7adSmrg if (instr.i_fmovcc.i_cond != cond) return(0); /* success */
368feddb7adSmrg rs1 = fs->fs_regs[rs2];
369feddb7adSmrg goto mov;
370feddb7adSmrg case FMVFC2 >> 2:
371dd5c54d0Seeh DPRINTF(FPE_INSN, ("fpu_execute: FMVFC2\n"));
372feddb7adSmrg cond = (fs->fs_fsr>>FSR_FCC2_SHIFT)&FSR_FCC_MASK;
373feddb7adSmrg if (instr.i_fmovcc.i_cond != cond) return(0); /* success */
374feddb7adSmrg rs1 = fs->fs_regs[rs2];
375feddb7adSmrg goto mov;
376feddb7adSmrg case FMVFC3 >> 2:
377dd5c54d0Seeh DPRINTF(FPE_INSN, ("fpu_execute: FMVFC3\n"));
378feddb7adSmrg cond = (fs->fs_fsr>>FSR_FCC3_SHIFT)&FSR_FCC_MASK;
379feddb7adSmrg if (instr.i_fmovcc.i_cond != cond) return(0); /* success */
380feddb7adSmrg rs1 = fs->fs_regs[rs2];
381feddb7adSmrg goto mov;
382feddb7adSmrg case FMVIC >> 2:
383c464d72fSthorpej /* Presume we're curlwp */
384dd5c54d0Seeh DPRINTF(FPE_INSN, ("fpu_execute: FMVIC\n"));
385c464d72fSthorpej cond = (curlwp->l_md.md_tf->tf_tstate>>TSTATE_CCR_SHIFT)&PSR_ICC;
386feddb7adSmrg if (instr.i_fmovcc.i_cond != cond) return(0); /* success */
387feddb7adSmrg rs1 = fs->fs_regs[rs2];
388feddb7adSmrg goto mov;
389feddb7adSmrg case FMVXC >> 2:
390c464d72fSthorpej /* Presume we're curlwp */
391dd5c54d0Seeh DPRINTF(FPE_INSN, ("fpu_execute: FMVXC\n"));
392c464d72fSthorpej cond = (curlwp->l_md.md_tf->tf_tstate>>(TSTATE_CCR_SHIFT+XCC_SHIFT))&PSR_ICC;
393feddb7adSmrg if (instr.i_fmovcc.i_cond != cond) return(0); /* success */
394feddb7adSmrg rs1 = fs->fs_regs[rs2];
395feddb7adSmrg goto mov;
396feddb7adSmrg case FMVRZ >> 2:
397c464d72fSthorpej /* Presume we're curlwp */
398dd5c54d0Seeh DPRINTF(FPE_INSN, ("fpu_execute: FMVRZ\n"));
399feddb7adSmrg rs1 = instr.i_fmovr.i_rs1;
400c464d72fSthorpej if (rs1 != 0 && (int64_t)curlwp->l_md.md_tf->tf_global[rs1] != 0)
401feddb7adSmrg return (0); /* success */
402feddb7adSmrg rs1 = fs->fs_regs[rs2];
403feddb7adSmrg goto mov;
404feddb7adSmrg case FMVRLEZ >> 2:
405c464d72fSthorpej /* Presume we're curlwp */
406dd5c54d0Seeh DPRINTF(FPE_INSN, ("fpu_execute: FMVRLEZ\n"));
407feddb7adSmrg rs1 = instr.i_fmovr.i_rs1;
408c464d72fSthorpej if (rs1 != 0 && (int64_t)curlwp->l_md.md_tf->tf_global[rs1] > 0)
409feddb7adSmrg return (0); /* success */
410feddb7adSmrg rs1 = fs->fs_regs[rs2];
411feddb7adSmrg goto mov;
412feddb7adSmrg case FMVRLZ >> 2:
413c464d72fSthorpej /* Presume we're curlwp */
414dd5c54d0Seeh DPRINTF(FPE_INSN, ("fpu_execute: FMVRLZ\n"));
415feddb7adSmrg rs1 = instr.i_fmovr.i_rs1;
416c464d72fSthorpej if (rs1 == 0 || (int64_t)curlwp->l_md.md_tf->tf_global[rs1] >= 0)
417feddb7adSmrg return (0); /* success */
418feddb7adSmrg rs1 = fs->fs_regs[rs2];
419feddb7adSmrg goto mov;
420feddb7adSmrg case FMVRNZ >> 2:
421c464d72fSthorpej /* Presume we're curlwp */
422dd5c54d0Seeh DPRINTF(FPE_INSN, ("fpu_execute: FMVRNZ\n"));
423feddb7adSmrg rs1 = instr.i_fmovr.i_rs1;
424c464d72fSthorpej if (rs1 == 0 || (int64_t)curlwp->l_md.md_tf->tf_global[rs1] == 0)
425feddb7adSmrg return (0); /* success */
426feddb7adSmrg rs1 = fs->fs_regs[rs2];
427feddb7adSmrg goto mov;
428feddb7adSmrg case FMVRGZ >> 2:
429c464d72fSthorpej /* Presume we're curlwp */
430dd5c54d0Seeh DPRINTF(FPE_INSN, ("fpu_execute: FMVRGZ\n"));
431feddb7adSmrg rs1 = instr.i_fmovr.i_rs1;
432c464d72fSthorpej if (rs1 == 0 || (int64_t)curlwp->l_md.md_tf->tf_global[rs1] <= 0)
433feddb7adSmrg return (0); /* success */
434feddb7adSmrg rs1 = fs->fs_regs[rs2];
435feddb7adSmrg goto mov;
436feddb7adSmrg case FMVRGEZ >> 2:
437c464d72fSthorpej /* Presume we're curlwp */
438dd5c54d0Seeh DPRINTF(FPE_INSN, ("fpu_execute: FMVRGEZ\n"));
439feddb7adSmrg rs1 = instr.i_fmovr.i_rs1;
440c464d72fSthorpej if (rs1 != 0 && (int64_t)curlwp->l_md.md_tf->tf_global[rs1] < 0)
441feddb7adSmrg return (0); /* success */
442feddb7adSmrg rs1 = fs->fs_regs[rs2];
443feddb7adSmrg goto mov;
444feddb7adSmrg default:
445dd5c54d0Seeh DPRINTF(FPE_INSN,
446dd5c54d0Seeh ("fpu_execute: unknown v9 FP inst %x opf %x\n",
447dd5c54d0Seeh instr.i_int, opf));
448feddb7adSmrg return (NOTFPU);
449feddb7adSmrg }
450feddb7adSmrg }
451feddb7adSmrg #endif /* SUN4U */
4524588caefSderaadt switch (opf >>= 2) {
4534588caefSderaadt
4544588caefSderaadt default:
455dd5c54d0Seeh DPRINTF(FPE_INSN,
456dd5c54d0Seeh ("fpu_execute: unknown basic FP inst %x opf %x\n",
457dd5c54d0Seeh instr.i_int, opf));
4584588caefSderaadt return (NOTFPU);
4594588caefSderaadt
4604588caefSderaadt case FMOV >> 2: /* these should all be pretty obvious */
461dd5c54d0Seeh DPRINTF(FPE_INSN, ("fpu_execute: FMOV\n"));
4624588caefSderaadt rs1 = fs->fs_regs[rs2];
4634588caefSderaadt goto mov;
4644588caefSderaadt
4654588caefSderaadt case FNEG >> 2:
466dd5c54d0Seeh DPRINTF(FPE_INSN, ("fpu_execute: FNEG\n"));
4674588caefSderaadt rs1 = fs->fs_regs[rs2] ^ (1 << 31);
4684588caefSderaadt goto mov;
4694588caefSderaadt
4704588caefSderaadt case FABS >> 2:
471dd5c54d0Seeh DPRINTF(FPE_INSN, ("fpu_execute: FABS\n"));
4724588caefSderaadt rs1 = fs->fs_regs[rs2] & ~(1 << 31);
4734588caefSderaadt mov:
474feddb7adSmrg #ifndef SUN4U
4754588caefSderaadt fs->fs_regs[rd] = rs1;
476feddb7adSmrg #else /* SUN4U */
477ebe55962Seeh i = 1<<(type-1);
478feddb7adSmrg fs->fs_regs[rd++] = rs1;
479ebe55962Seeh while (--i > 0)
480feddb7adSmrg fs->fs_regs[rd++] = fs->fs_regs[++rs2];
481feddb7adSmrg #endif /* SUN4U */
4824588caefSderaadt fs->fs_fsr = fe->fe_fsr;
4834588caefSderaadt return (0); /* success */
4844588caefSderaadt
4854588caefSderaadt case FSQRT >> 2:
486dd5c54d0Seeh DPRINTF(FPE_INSN, ("fpu_execute: FSQRT\n"));
4874588caefSderaadt fpu_explode(fe, &fe->fe_f1, type, rs2);
4884588caefSderaadt fp = fpu_sqrt(fe);
4894588caefSderaadt break;
4904588caefSderaadt
4914588caefSderaadt case FADD >> 2:
492dd5c54d0Seeh DPRINTF(FPE_INSN, ("fpu_execute: FADD\n"));
4934588caefSderaadt fpu_explode(fe, &fe->fe_f1, type, rs1);
4944588caefSderaadt fpu_explode(fe, &fe->fe_f2, type, rs2);
4954588caefSderaadt fp = fpu_add(fe);
4964588caefSderaadt break;
4974588caefSderaadt
4984588caefSderaadt case FSUB >> 2:
499dd5c54d0Seeh DPRINTF(FPE_INSN, ("fpu_execute: FSUB\n"));
5004588caefSderaadt fpu_explode(fe, &fe->fe_f1, type, rs1);
5014588caefSderaadt fpu_explode(fe, &fe->fe_f2, type, rs2);
5024588caefSderaadt fp = fpu_sub(fe);
5034588caefSderaadt break;
5044588caefSderaadt
5054588caefSderaadt case FMUL >> 2:
506dd5c54d0Seeh DPRINTF(FPE_INSN, ("fpu_execute: FMUL\n"));
5074588caefSderaadt fpu_explode(fe, &fe->fe_f1, type, rs1);
5084588caefSderaadt fpu_explode(fe, &fe->fe_f2, type, rs2);
5094588caefSderaadt fp = fpu_mul(fe);
5104588caefSderaadt break;
5114588caefSderaadt
5124588caefSderaadt case FDIV >> 2:
513dd5c54d0Seeh DPRINTF(FPE_INSN, ("fpu_execute: FDIV\n"));
5144588caefSderaadt fpu_explode(fe, &fe->fe_f1, type, rs1);
5154588caefSderaadt fpu_explode(fe, &fe->fe_f2, type, rs2);
5164588caefSderaadt fp = fpu_div(fe);
5174588caefSderaadt break;
5184588caefSderaadt
5194588caefSderaadt case FCMP >> 2:
520dd5c54d0Seeh DPRINTF(FPE_INSN, ("fpu_execute: FCMP\n"));
5214588caefSderaadt fpu_explode(fe, &fe->fe_f1, type, rs1);
5224588caefSderaadt fpu_explode(fe, &fe->fe_f2, type, rs2);
5234588caefSderaadt fpu_compare(fe, 0);
5244588caefSderaadt goto cmpdone;
5254588caefSderaadt
5264588caefSderaadt case FCMPE >> 2:
527dd5c54d0Seeh DPRINTF(FPE_INSN, ("fpu_execute: FCMPE\n"));
5284588caefSderaadt fpu_explode(fe, &fe->fe_f1, type, rs1);
5294588caefSderaadt fpu_explode(fe, &fe->fe_f2, type, rs2);
5304588caefSderaadt fpu_compare(fe, 1);
5314588caefSderaadt cmpdone:
5324588caefSderaadt /*
5334588caefSderaadt * The only possible exception here is NV; catch it
5344588caefSderaadt * early and get out, as there is no result register.
5354588caefSderaadt */
5364588caefSderaadt cx = fe->fe_cx;
5374588caefSderaadt fsr = fe->fe_fsr | (cx << FSR_CX_SHIFT);
5384588caefSderaadt if (cx != 0) {
5394588caefSderaadt if (fsr & (FSR_NV << FSR_TEM_SHIFT)) {
5404588caefSderaadt fs->fs_fsr = (fsr & ~FSR_FTT) |
5414588caefSderaadt (FSR_TT_IEEE << FSR_FTT_SHIFT);
5424588caefSderaadt return (FPE);
5434588caefSderaadt }
5444588caefSderaadt fsr |= FSR_NV << FSR_AX_SHIFT;
5454588caefSderaadt }
5464588caefSderaadt fs->fs_fsr = fsr;
5474588caefSderaadt return (0);
5484588caefSderaadt
5494588caefSderaadt case FSMULD >> 2:
5504588caefSderaadt case FDMULX >> 2:
551dd5c54d0Seeh DPRINTF(FPE_INSN, ("fpu_execute: FSMULx\n"));
5524588caefSderaadt if (type == FTYPE_EXT)
5534588caefSderaadt return (NOTFPU);
5544588caefSderaadt fpu_explode(fe, &fe->fe_f1, type, rs1);
5554588caefSderaadt fpu_explode(fe, &fe->fe_f2, type, rs2);
5564588caefSderaadt type++; /* single to double, or double to quad */
5574588caefSderaadt fp = fpu_mul(fe);
5584588caefSderaadt break;
5594588caefSderaadt
560feddb7adSmrg #ifdef SUN4U
561feddb7adSmrg case FXTOS >> 2:
562feddb7adSmrg case FXTOD >> 2:
563feddb7adSmrg case FXTOQ >> 2:
564dd5c54d0Seeh DPRINTF(FPE_INSN, ("fpu_execute: FXTOx\n"));
565feddb7adSmrg type = FTYPE_LNG;
566feddb7adSmrg fpu_explode(fe, fp = &fe->fe_f1, type, rs2);
567feddb7adSmrg type = opf & 3; /* sneaky; depends on instruction encoding */
568feddb7adSmrg break;
569feddb7adSmrg
570feddb7adSmrg case FTOX >> 2:
571112afe4fSeeh DPRINTF(FPE_INSN, ("fpu_execute: FTOX\n"));
572feddb7adSmrg fpu_explode(fe, fp = &fe->fe_f1, type, rs2);
573feddb7adSmrg type = FTYPE_LNG;
574112afe4fSeeh /* Recalculate destination register */
575112afe4fSeeh rd = instr.i_opf.i_rd;
576dd5c54d0Seeh break;
577feddb7adSmrg
578112afe4fSeeh #endif /* SUN4U */
579ebe55962Seeh case FTOI >> 2:
580112afe4fSeeh DPRINTF(FPE_INSN, ("fpu_execute: FTOI\n"));
581112afe4fSeeh fpu_explode(fe, fp = &fe->fe_f1, type, rs2);
582112afe4fSeeh type = FTYPE_INT;
583112afe4fSeeh /* Recalculate destination register */
584112afe4fSeeh rd = instr.i_opf.i_rd;
585112afe4fSeeh break;
586112afe4fSeeh
5874588caefSderaadt case FTOS >> 2:
5884588caefSderaadt case FTOD >> 2:
589feddb7adSmrg case FTOQ >> 2:
590dd5c54d0Seeh DPRINTF(FPE_INSN, ("fpu_execute: FTOx\n"));
5914588caefSderaadt fpu_explode(fe, fp = &fe->fe_f1, type, rs2);
592112afe4fSeeh /* Recalculate rd with correct type info. */
5934588caefSderaadt type = opf & 3; /* sneaky; depends on instruction encoding */
594112afe4fSeeh mask = 0x3 >> (3 - type);
595112afe4fSeeh rd = instr.i_opf.i_rd;
596112afe4fSeeh rd = (rd & ~mask) | ((rd & mask & 0x1) << 5);
5974588caefSderaadt break;
5984588caefSderaadt }
5994588caefSderaadt
6004588caefSderaadt /*
6014588caefSderaadt * ALU operation is complete. Collapse the result and then check
6024588caefSderaadt * for exceptions. If we got any, and they are enabled, do not
6034588caefSderaadt * alter the destination register, just stop with an exception.
6044588caefSderaadt * Otherwise set new current exceptions and accrue.
6054588caefSderaadt */
6064588caefSderaadt fpu_implode(fe, fp, type, space);
6074588caefSderaadt cx = fe->fe_cx;
6084588caefSderaadt fsr = fe->fe_fsr;
6094588caefSderaadt if (cx != 0) {
6104588caefSderaadt mask = (fsr >> FSR_TEM_SHIFT) & FSR_TEM_MASK;
6114588caefSderaadt if (cx & mask) {
6124588caefSderaadt /* not accrued??? */
6134588caefSderaadt fs->fs_fsr = (fsr & ~FSR_FTT) |
6144588caefSderaadt (FSR_TT_IEEE << FSR_FTT_SHIFT) |
6154588caefSderaadt (cx_to_trapx[(cx & mask) - 1] << FSR_CX_SHIFT);
6164588caefSderaadt return (FPE);
6174588caefSderaadt }
6184588caefSderaadt fsr |= (cx << FSR_CX_SHIFT) | (cx << FSR_AX_SHIFT);
6194588caefSderaadt }
6204588caefSderaadt fs->fs_fsr = fsr;
621112afe4fSeeh DPRINTF(FPE_REG, ("-> %c%d\n", (type == FTYPE_LNG) ? 'x' :
622112afe4fSeeh ((type == FTYPE_INT) ? 'i' :
623112afe4fSeeh ((type == FTYPE_SNG) ? 's' :
624112afe4fSeeh ((type == FTYPE_DBL) ? 'd' :
625112afe4fSeeh ((type == FTYPE_EXT) ? 'q' : '?')))),
626112afe4fSeeh rd));
6274588caefSderaadt fs->fs_regs[rd] = space[0];
6281f76e23fSpk if (type >= FTYPE_DBL || type == FTYPE_LNG) {
6294588caefSderaadt fs->fs_regs[rd + 1] = space[1];
6304588caefSderaadt if (type > FTYPE_DBL) {
6314588caefSderaadt fs->fs_regs[rd + 2] = space[2];
6324588caefSderaadt fs->fs_regs[rd + 3] = space[3];
6334588caefSderaadt }
6344588caefSderaadt }
6354588caefSderaadt return (0); /* success */
6364588caefSderaadt }
637