xref: /netbsd-src/sys/arch/sparc/fpu/fpu.c (revision 8c2f80f160efd6e997c0f045f56c727c8ad9d256)
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