Home | History | Annotate | Line # | Download | only in fpu
fpu.c revision 1.22
      1  1.22        pk /*	$NetBSD: fpu.c,v 1.22 2003/10/06 07:10:41 pk Exp $ */
      2   1.2   deraadt 
      3   1.1   deraadt /*
      4   1.1   deraadt  * Copyright (c) 1992, 1993
      5   1.1   deraadt  *	The Regents of the University of California.  All rights reserved.
      6   1.1   deraadt  *
      7   1.1   deraadt  * This software was developed by the Computer Systems Engineering group
      8   1.1   deraadt  * at Lawrence Berkeley Laboratory under DARPA contract BG 91-66 and
      9   1.1   deraadt  * contributed to Berkeley.
     10   1.1   deraadt  *
     11   1.1   deraadt  * All advertising materials mentioning features or use of this software
     12   1.1   deraadt  * must display the following acknowledgement:
     13   1.1   deraadt  *	This product includes software developed by the University of
     14   1.1   deraadt  *	California, Lawrence Berkeley Laboratory.
     15   1.1   deraadt  *
     16   1.1   deraadt  * Redistribution and use in source and binary forms, with or without
     17   1.1   deraadt  * modification, are permitted provided that the following conditions
     18   1.1   deraadt  * are met:
     19   1.1   deraadt  * 1. Redistributions of source code must retain the above copyright
     20   1.1   deraadt  *    notice, this list of conditions and the following disclaimer.
     21   1.1   deraadt  * 2. Redistributions in binary form must reproduce the above copyright
     22   1.1   deraadt  *    notice, this list of conditions and the following disclaimer in the
     23   1.1   deraadt  *    documentation and/or other materials provided with the distribution.
     24  1.20       agc  * 3. Neither the name of the University nor the names of its contributors
     25   1.1   deraadt  *    may be used to endorse or promote products derived from this software
     26   1.1   deraadt  *    without specific prior written permission.
     27   1.1   deraadt  *
     28   1.1   deraadt  * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
     29   1.1   deraadt  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
     30   1.1   deraadt  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
     31   1.1   deraadt  * ARE DISCLAIMED.  IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
     32   1.1   deraadt  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
     33   1.1   deraadt  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
     34   1.1   deraadt  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
     35   1.1   deraadt  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
     36   1.1   deraadt  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
     37   1.1   deraadt  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
     38   1.1   deraadt  * SUCH DAMAGE.
     39   1.1   deraadt  *
     40   1.1   deraadt  *	@(#)fpu.c	8.1 (Berkeley) 6/11/93
     41   1.1   deraadt  */
     42  1.19     lukem 
     43  1.19     lukem #include <sys/cdefs.h>
     44  1.22        pk __KERNEL_RCSID(0, "$NetBSD: fpu.c,v 1.22 2003/10/06 07:10:41 pk Exp $");
     45   1.1   deraadt 
     46   1.1   deraadt #include <sys/param.h>
     47   1.1   deraadt #include <sys/proc.h>
     48   1.1   deraadt #include <sys/signal.h>
     49   1.1   deraadt #include <sys/systm.h>
     50   1.1   deraadt #include <sys/syslog.h>
     51   1.3  christos #include <sys/signalvar.h>
     52   1.1   deraadt 
     53   1.1   deraadt #include <machine/instr.h>
     54   1.1   deraadt #include <machine/reg.h>
     55   1.1   deraadt 
     56   1.1   deraadt #include <sparc/fpu/fpu_emu.h>
     57   1.3  christos #include <sparc/fpu/fpu_extern.h>
     58   1.1   deraadt 
     59   1.8       eeh int fpe_debug = 0;
     60   1.8       eeh 
     61   1.8       eeh #ifdef DEBUG
     62   1.8       eeh /*
     63   1.8       eeh  * Dump a `fpn' structure.
     64   1.8       eeh  */
     65   1.8       eeh void
     66   1.8       eeh fpu_dumpfpn(struct fpn *fp)
     67   1.8       eeh {
     68   1.8       eeh 	static char *class[] = {
     69   1.8       eeh 		"SNAN", "QNAN", "ZERO", "NUM", "INF"
     70   1.8       eeh 	};
     71   1.8       eeh 
     72   1.8       eeh 	printf("%s %c.%x %x %x %xE%d", class[fp->fp_class + 2],
     73   1.8       eeh 		fp->fp_sign ? '-' : ' ',
     74   1.8       eeh 		fp->fp_mant[0],	fp->fp_mant[1],
     75   1.8       eeh 		fp->fp_mant[2], fp->fp_mant[3],
     76   1.8       eeh 		fp->fp_exp);
     77   1.8       eeh }
     78   1.8       eeh #endif
     79   1.8       eeh 
     80   1.1   deraadt /*
     81   1.1   deraadt  * fpu_execute returns the following error numbers (0 = no error):
     82   1.1   deraadt  */
     83   1.1   deraadt #define	FPE		1	/* take a floating point exception */
     84   1.1   deraadt #define	NOTFPU		2	/* not an FPU instruction */
     85   1.1   deraadt 
     86   1.1   deraadt /*
     87   1.1   deraadt  * Translate current exceptions into `first' exception.  The
     88   1.1   deraadt  * bits go the wrong way for ffs() (0x10 is most important, etc).
     89   1.1   deraadt  * There are only 5, so do it the obvious way.
     90   1.1   deraadt  */
     91   1.1   deraadt #define	X1(x) x
     92   1.1   deraadt #define	X2(x) x,x
     93   1.1   deraadt #define	X4(x) x,x,x,x
     94   1.1   deraadt #define	X8(x) X4(x),X4(x)
     95   1.1   deraadt #define	X16(x) X8(x),X8(x)
     96   1.1   deraadt 
     97   1.1   deraadt static char cx_to_trapx[] = {
     98   1.1   deraadt 	X1(FSR_NX),
     99   1.1   deraadt 	X2(FSR_DZ),
    100   1.1   deraadt 	X4(FSR_UF),
    101   1.1   deraadt 	X8(FSR_OF),
    102   1.1   deraadt 	X16(FSR_NV)
    103   1.1   deraadt };
    104  1.21        pk static u_char fpu_codes_native[] = {
    105  1.21        pk 	X1(FPE_FLTRES),
    106  1.21        pk 	X2(FPE_FLTDIV),
    107  1.21        pk 	X4(FPE_FLTUND),
    108  1.21        pk 	X8(FPE_FLTOVF),
    109  1.21        pk 	X16(FPE_FLTINV)
    110  1.21        pk };
    111  1.22        pk #if defined(COMPAT_SUNOS)
    112  1.22        pk static u_char fpu_codes_sunos[] = {
    113   1.1   deraadt 	X1(FPE_FLTINEX_TRAP),
    114   1.1   deraadt 	X2(FPE_FLTDIV_TRAP),
    115   1.1   deraadt 	X4(FPE_FLTUND_TRAP),
    116   1.1   deraadt 	X8(FPE_FLTOVF_TRAP),
    117   1.1   deraadt 	X16(FPE_FLTOPERR_TRAP)
    118   1.1   deraadt };
    119  1.21        pk extern struct emul emul_sunos;
    120  1.22        pk #endif /* SUNOS_COMPAT */
    121  1.22        pk /* Note: SVR4(Solaris) FPE_* codes happen to be compatible with ours */
    122   1.1   deraadt 
    123   1.1   deraadt /*
    124   1.1   deraadt  * The FPU gave us an exception.  Clean up the mess.  Note that the
    125   1.1   deraadt  * fp queue can only have FPops in it, never load/store FP registers
    126   1.1   deraadt  * nor FBfcc instructions.  Experiments with `crashme' prove that
    127   1.1   deraadt  * unknown FPops do enter the queue, however.
    128   1.1   deraadt  */
    129   1.3  christos void
    130  1.17   thorpej fpu_cleanup(l, fs)
    131  1.21        pk 	struct lwp *l;
    132   1.7       mrg #ifndef SUN4U
    133  1.21        pk 	struct fpstate *fs;
    134   1.7       mrg #else /* SUN4U */
    135  1.21        pk 	struct fpstate64 *fs;
    136   1.7       mrg #endif /* SUN4U */
    137   1.1   deraadt {
    138  1.21        pk 	int i, fsr = fs->fs_fsr, error;
    139  1.17   thorpej 	struct proc *p = l->l_proc;
    140   1.1   deraadt 	union instr instr;
    141   1.1   deraadt 	struct fpemu fe;
    142  1.21        pk 	u_char *fpu_codes;
    143  1.21        pk 	ksiginfo_t ksi;
    144  1.21        pk 
    145  1.22        pk 	fpu_codes =
    146  1.21        pk #ifdef COMPAT_SUNOS
    147  1.22        pk 		(p->p_emul == &emul_sunos) ? fpu_codes_sunos :
    148  1.21        pk #endif
    149  1.22        pk 		fpu_codes_native;
    150   1.1   deraadt 
    151   1.1   deraadt 	switch ((fsr >> FSR_FTT_SHIFT) & FSR_FTT_MASK) {
    152   1.1   deraadt 
    153   1.1   deraadt 	case FSR_TT_NONE:
    154   1.7       mrg 		panic("fpu_cleanup: No fault");	/* ??? */
    155   1.1   deraadt 		break;
    156   1.1   deraadt 
    157   1.1   deraadt 	case FSR_TT_IEEE:
    158  1.14       eeh 		DPRINTF(FPE_INSN, ("fpu_cleanup: FSR_TT_IEEE\n"));
    159   1.1   deraadt 		/* XXX missing trap address! */
    160   1.1   deraadt 		if ((i = fsr & FSR_CX) == 0)
    161   1.1   deraadt 			panic("fpu ieee trap, but no exception");
    162  1.21        pk 		ksi.ksi_signo = SIGFPE;
    163  1.21        pk 		ksi.ksi_code = fpu_codes[i - 1];
    164  1.17   thorpej 		KERNEL_PROC_LOCK(l);
    165  1.21        pk #ifdef __HAVE_SIGINFO
    166  1.21        pk 		trapsignal(l, &ksi);
    167  1.21        pk #else
    168  1.21        pk 		trapsignal(l, ksi.ksi_signo, ksi.ksi_code);
    169  1.21        pk #endif
    170  1.17   thorpej 		KERNEL_PROC_UNLOCK(l);
    171   1.1   deraadt 		break;		/* XXX should return, but queue remains */
    172   1.1   deraadt 
    173   1.1   deraadt 	case FSR_TT_UNFIN:
    174  1.14       eeh 		DPRINTF(FPE_INSN, ("fpu_cleanup: FSR_TT_UNFIN\n"));
    175   1.7       mrg #ifdef SUN4U
    176   1.7       mrg 		if (fs->fs_qsize == 0) {
    177   1.7       mrg 			printf("fpu_cleanup: unfinished fpop");
    178   1.7       mrg 			/* The book sez reexecute or emulate. */
    179   1.7       mrg 			return;
    180   1.7       mrg 		}
    181   1.7       mrg 		break;
    182   1.7       mrg 
    183   1.7       mrg #endif /* SUN4U */
    184   1.1   deraadt 	case FSR_TT_UNIMP:
    185  1.14       eeh 		DPRINTF(FPE_INSN, ("fpu_cleanup: FSR_TT_UNIMP\n"));
    186   1.1   deraadt 		if (fs->fs_qsize == 0)
    187   1.7       mrg 			panic("fpu_cleanup: unimplemented fpop");
    188   1.1   deraadt 		break;
    189   1.1   deraadt 
    190   1.1   deraadt 	case FSR_TT_SEQ:
    191   1.1   deraadt 		panic("fpu sequence error");
    192   1.1   deraadt 		/* NOTREACHED */
    193   1.1   deraadt 
    194   1.1   deraadt 	case FSR_TT_HWERR:
    195  1.14       eeh 		DPRINTF(FPE_INSN, ("fpu_cleanup: FSR_TT_HWERR\n"));
    196   1.1   deraadt 		log(LOG_ERR, "fpu hardware error (%s[%d])\n",
    197   1.1   deraadt 		    p->p_comm, p->p_pid);
    198   1.1   deraadt 		uprintf("%s[%d]: fpu hardware error\n", p->p_comm, p->p_pid);
    199  1.21        pk 		ksi.ksi_signo = SIGFPE;
    200  1.21        pk 		ksi.ksi_code = 0;
    201  1.17   thorpej 		KERNEL_PROC_LOCK(l);
    202  1.21        pk #ifdef __HAVE_SIGINFO
    203  1.21        pk 		trapsignal(l, &ksi);
    204  1.21        pk #else
    205  1.21        pk 		trapsignal(l, ksi.ksi_signo, ksi.ksi_code);
    206  1.21        pk #endif
    207  1.17   thorpej 		KERNEL_PROC_UNLOCK(l);
    208   1.1   deraadt 		goto out;
    209   1.1   deraadt 
    210   1.1   deraadt 	default:
    211   1.6      fair 		printf("fsr=0x%x\n", fsr);
    212   1.1   deraadt 		panic("fpu error");
    213   1.1   deraadt 	}
    214   1.1   deraadt 
    215   1.1   deraadt 	/* emulate the instructions left in the queue */
    216   1.1   deraadt 	fe.fe_fpstate = fs;
    217   1.1   deraadt 	for (i = 0; i < fs->fs_qsize; i++) {
    218   1.1   deraadt 		instr.i_int = fs->fs_queue[i].fq_instr;
    219   1.1   deraadt 		if (instr.i_any.i_op != IOP_reg ||
    220   1.1   deraadt 		    (instr.i_op3.i_op3 != IOP3_FPop1 &&
    221   1.1   deraadt 		     instr.i_op3.i_op3 != IOP3_FPop2))
    222   1.1   deraadt 			panic("bogus fpu queue");
    223   1.1   deraadt 		error = fpu_execute(&fe, instr);
    224  1.16        pk 		if (error == 0)
    225   1.1   deraadt 			continue;
    226   1.1   deraadt 
    227  1.17   thorpej 		KERNEL_PROC_LOCK(l);
    228  1.16        pk 		switch (error) {
    229   1.1   deraadt 		case FPE:
    230  1.21        pk 			ksi.ksi_signo = SIGFPE;
    231  1.21        pk 			ksi.ksi_code = fpu_codes[(fs->fs_fsr & FSR_CX) - 1];
    232  1.21        pk #ifdef __HAVE_SIGINFO
    233  1.21        pk 			trapsignal(l, &ksi);
    234  1.21        pk #else
    235  1.21        pk 			trapsignal(l, ksi.ksi_signo, ksi.ksi_code);
    236  1.21        pk #endif
    237   1.1   deraadt 			break;
    238   1.1   deraadt 
    239   1.1   deraadt 		case NOTFPU:
    240   1.7       mrg #ifdef SUN4U
    241   1.7       mrg #ifdef DEBUG
    242  1.11       mrg 			printf("fpu_cleanup: not an FPU error -- sending SIGILL\n");
    243   1.7       mrg #endif
    244   1.7       mrg #endif /* SUN4U */
    245  1.21        pk 			ksi.ksi_signo = SIGFPE;
    246  1.21        pk 			ksi.ksi_code = ILL_ILLOPC;
    247  1.21        pk #ifdef __HAVE_SIGINFO
    248  1.21        pk 			trapsignal(l, &ksi);
    249  1.21        pk #else
    250  1.21        pk 			trapsignal(l, ksi.ksi_signo, ksi.ksi_code);
    251  1.21        pk #endif
    252   1.1   deraadt 			break;
    253   1.1   deraadt 
    254   1.1   deraadt 		default:
    255   1.1   deraadt 			panic("fpu_cleanup 3");
    256   1.1   deraadt 			/* NOTREACHED */
    257   1.1   deraadt 		}
    258  1.17   thorpej 		KERNEL_PROC_UNLOCK(l);
    259   1.1   deraadt 		/* XXX should stop here, but queue remains */
    260   1.1   deraadt 	}
    261   1.1   deraadt out:
    262   1.1   deraadt 	fs->fs_qsize = 0;
    263   1.1   deraadt }
    264   1.1   deraadt 
    265   1.1   deraadt #ifdef notyet
    266   1.1   deraadt /*
    267   1.1   deraadt  * If we have no FPU at all (are there any machines like this out
    268   1.1   deraadt  * there!?) we have to emulate each instruction, and we need a pointer
    269   1.1   deraadt  * to the trapframe so that we can step over them and do FBfcc's.
    270   1.1   deraadt  * We know the `queue' is empty, though; we just want to emulate
    271   1.1   deraadt  * the instruction at tf->tf_pc.
    272   1.1   deraadt  */
    273  1.17   thorpej fpu_emulate(l, tf, fs)
    274  1.17   thorpej 	struct lwp *l;
    275  1.21        pk 	struct trapframe *tf;
    276   1.7       mrg #ifndef SUN4U
    277  1.21        pk 	struct fpstate *fs;
    278   1.7       mrg #else /* SUN4U */
    279  1.21        pk 	struct fpstate64 *fs;
    280   1.7       mrg #endif /* SUN4U */
    281   1.1   deraadt {
    282   1.1   deraadt 
    283   1.1   deraadt 	do {
    284   1.1   deraadt 		fetch instr from pc
    285   1.1   deraadt 		decode
    286   1.1   deraadt 		if (integer instr) {
    287   1.1   deraadt 			/*
    288   1.1   deraadt 			 * We do this here, rather than earlier, to avoid
    289   1.1   deraadt 			 * losing even more badly than usual.
    290   1.1   deraadt 			 */
    291  1.17   thorpej 			if (l->l_addr->u_pcb.pcb_uw) {
    292   1.1   deraadt 				write_user_windows();
    293  1.17   thorpej 				if (rwindow_save(l))
    294  1.17   thorpej 					sigexit(l, SIGILL);
    295   1.1   deraadt 			}
    296   1.1   deraadt 			if (loadstore) {
    297   1.1   deraadt 				do_it;
    298   1.1   deraadt 				pc = npc, npc += 4
    299   1.1   deraadt 			} else if (fbfcc) {
    300   1.1   deraadt 				do_annul_stuff;
    301   1.1   deraadt 			} else
    302   1.1   deraadt 				return;
    303   1.1   deraadt 		} else if (fpu instr) {
    304   1.1   deraadt 			fe.fe_fsr = fs->fs_fsr &= ~FSR_CX;
    305   1.1   deraadt 			error = fpu_execute(&fe, fs, instr);
    306   1.1   deraadt 			switch (error) {
    307   1.1   deraadt 				etc;
    308   1.1   deraadt 			}
    309   1.1   deraadt 		} else
    310   1.1   deraadt 			return;
    311   1.1   deraadt 		if (want to reschedule)
    312   1.1   deraadt 			return;
    313   1.1   deraadt 	} while (error == 0);
    314   1.1   deraadt }
    315   1.1   deraadt #endif
    316   1.1   deraadt 
    317   1.1   deraadt /*
    318   1.1   deraadt  * Execute an FPU instruction (one that runs entirely in the FPU; not
    319   1.1   deraadt  * FBfcc or STF, for instance).  On return, fe->fe_fs->fs_fsr will be
    320   1.1   deraadt  * modified to reflect the setting the hardware would have left.
    321   1.1   deraadt  *
    322   1.1   deraadt  * Note that we do not catch all illegal opcodes, so you can, for instance,
    323   1.1   deraadt  * multiply two integers this way.
    324   1.1   deraadt  */
    325   1.1   deraadt int
    326   1.1   deraadt fpu_execute(fe, instr)
    327  1.21        pk 	struct fpemu *fe;
    328   1.1   deraadt 	union instr instr;
    329   1.1   deraadt {
    330  1.21        pk 	struct fpn *fp;
    331   1.7       mrg #ifndef SUN4U
    332  1.21        pk 	int opf, rs1, rs2, rd, type, mask, fsr, cx;
    333  1.21        pk 	struct fpstate *fs;
    334   1.7       mrg #else /* SUN4U */
    335  1.21        pk 	int opf, rs1, rs2, rd, type, mask, fsr, cx, i, cond;
    336  1.21        pk 	struct fpstate64 *fs;
    337   1.7       mrg #endif /* SUN4U */
    338   1.1   deraadt 	u_int space[4];
    339  1.14       eeh 
    340   1.1   deraadt 	/*
    341   1.1   deraadt 	 * `Decode' and execute instruction.  Start with no exceptions.
    342   1.1   deraadt 	 * The type of any i_opf opcode is in the bottom two bits, so we
    343   1.1   deraadt 	 * squish them out here.
    344   1.1   deraadt 	 */
    345   1.1   deraadt 	opf = instr.i_opf.i_opf;
    346  1.12       eeh 	/*
    347  1.12       eeh 	 * The low two bits of the opf field for floating point insns usually
    348  1.12       eeh 	 * correspond to the operation width:
    349  1.12       eeh 	 *
    350  1.12       eeh 	 *	0:	Invalid
    351  1.12       eeh 	 *	1:	Single precision float
    352  1.12       eeh 	 *	2:	Double precision float
    353  1.12       eeh 	 *	3:	Quad precision float
    354  1.12       eeh 	 *
    355  1.12       eeh 	 * The exceptions are the integer to float conversion instructions.
    356  1.12       eeh 	 *
    357  1.12       eeh 	 * For double and quad precision, the low bit if the rs or rd field
    358  1.12       eeh 	 * is actually the high bit of the register number.
    359  1.12       eeh 	 */
    360  1.12       eeh 
    361   1.1   deraadt 	type = opf & 3;
    362  1.12       eeh 	mask = 0x3 >> (3 - type);
    363  1.12       eeh 
    364  1.12       eeh 	rs1 = instr.i_opf.i_rs1;
    365  1.12       eeh 	rs1 = (rs1 & ~mask) | ((rs1 & mask & 0x1) << 5);
    366  1.12       eeh 	rs2 = instr.i_opf.i_rs2;
    367  1.12       eeh 	rs2 = (rs2 & ~mask) | ((rs2 & mask & 0x1) << 5);
    368  1.12       eeh 	rd = instr.i_opf.i_rd;
    369  1.12       eeh 	rd = (rd & ~mask) | ((rd & mask & 0x1) << 5);
    370  1.12       eeh #ifdef DIAGNOSTIC
    371   1.1   deraadt 	if ((rs1 | rs2 | rd) & mask)
    372  1.13       eeh 		/* This may be an FPU insn but it is illegal. */
    373  1.13       eeh 		return (NOTFPU);
    374   1.1   deraadt #endif
    375   1.1   deraadt 	fs = fe->fe_fpstate;
    376   1.1   deraadt 	fe->fe_fsr = fs->fs_fsr & ~FSR_CX;
    377   1.1   deraadt 	fe->fe_cx = 0;
    378   1.7       mrg #ifdef SUN4U
    379   1.7       mrg 	/*
    380   1.7       mrg 	 * Check to see if we're dealing with a fancy cmove and handle
    381  1.12       eeh 	 * it first.
    382   1.7       mrg 	 */
    383   1.7       mrg 	if (instr.i_op3.i_op3 == IOP3_FPop2 && (opf&0xff0) != (FCMP&0xff0)) {
    384   1.7       mrg 		switch (opf >>= 2) {
    385   1.7       mrg 		case FMVFC0 >> 2:
    386   1.8       eeh 			DPRINTF(FPE_INSN, ("fpu_execute: FMVFC0\n"));
    387   1.7       mrg 			cond = (fs->fs_fsr>>FSR_FCC_SHIFT)&FSR_FCC_MASK;
    388   1.7       mrg 			if (instr.i_fmovcc.i_cond != cond) return(0); /* success */
    389   1.7       mrg 			rs1 = fs->fs_regs[rs2];
    390   1.7       mrg 			goto mov;
    391   1.7       mrg 		case FMVFC1 >> 2:
    392   1.8       eeh 			DPRINTF(FPE_INSN, ("fpu_execute: FMVFC1\n"));
    393   1.7       mrg 			cond = (fs->fs_fsr>>FSR_FCC1_SHIFT)&FSR_FCC_MASK;
    394   1.7       mrg 			if (instr.i_fmovcc.i_cond != cond) return(0); /* success */
    395   1.7       mrg 			rs1 = fs->fs_regs[rs2];
    396   1.7       mrg 			goto mov;
    397   1.7       mrg 		case FMVFC2 >> 2:
    398   1.8       eeh 			DPRINTF(FPE_INSN, ("fpu_execute: FMVFC2\n"));
    399   1.7       mrg 			cond = (fs->fs_fsr>>FSR_FCC2_SHIFT)&FSR_FCC_MASK;
    400   1.7       mrg 			if (instr.i_fmovcc.i_cond != cond) return(0); /* success */
    401   1.7       mrg 			rs1 = fs->fs_regs[rs2];
    402   1.7       mrg 			goto mov;
    403   1.7       mrg 		case FMVFC3 >> 2:
    404   1.8       eeh 			DPRINTF(FPE_INSN, ("fpu_execute: FMVFC3\n"));
    405   1.7       mrg 			cond = (fs->fs_fsr>>FSR_FCC3_SHIFT)&FSR_FCC_MASK;
    406   1.7       mrg 			if (instr.i_fmovcc.i_cond != cond) return(0); /* success */
    407   1.7       mrg 			rs1 = fs->fs_regs[rs2];
    408   1.7       mrg 			goto mov;
    409   1.7       mrg 		case FMVIC >> 2:
    410  1.17   thorpej 			/* Presume we're curlwp */
    411   1.8       eeh 			DPRINTF(FPE_INSN, ("fpu_execute: FMVIC\n"));
    412  1.17   thorpej 			cond = (curlwp->l_md.md_tf->tf_tstate>>TSTATE_CCR_SHIFT)&PSR_ICC;
    413   1.7       mrg 			if (instr.i_fmovcc.i_cond != cond) return(0); /* success */
    414   1.7       mrg 			rs1 = fs->fs_regs[rs2];
    415   1.7       mrg 			goto mov;
    416   1.7       mrg 		case FMVXC >> 2:
    417  1.17   thorpej 			/* Presume we're curlwp */
    418   1.8       eeh 			DPRINTF(FPE_INSN, ("fpu_execute: FMVXC\n"));
    419  1.17   thorpej 			cond = (curlwp->l_md.md_tf->tf_tstate>>(TSTATE_CCR_SHIFT+XCC_SHIFT))&PSR_ICC;
    420   1.7       mrg 			if (instr.i_fmovcc.i_cond != cond) return(0); /* success */
    421   1.7       mrg 			rs1 = fs->fs_regs[rs2];
    422   1.7       mrg 			goto mov;
    423   1.7       mrg 		case FMVRZ >> 2:
    424  1.17   thorpej 			/* Presume we're curlwp */
    425   1.8       eeh 			DPRINTF(FPE_INSN, ("fpu_execute: FMVRZ\n"));
    426   1.7       mrg 			rs1 = instr.i_fmovr.i_rs1;
    427  1.17   thorpej 			if (rs1 != 0 && (int64_t)curlwp->l_md.md_tf->tf_global[rs1] != 0)
    428   1.7       mrg 				return (0); /* success */
    429   1.7       mrg 			rs1 = fs->fs_regs[rs2];
    430   1.7       mrg 			goto mov;
    431   1.7       mrg 		case FMVRLEZ >> 2:
    432  1.17   thorpej 			/* Presume we're curlwp */
    433   1.8       eeh 			DPRINTF(FPE_INSN, ("fpu_execute: FMVRLEZ\n"));
    434   1.7       mrg 			rs1 = instr.i_fmovr.i_rs1;
    435  1.17   thorpej 			if (rs1 != 0 && (int64_t)curlwp->l_md.md_tf->tf_global[rs1] > 0)
    436   1.7       mrg 				return (0); /* success */
    437   1.7       mrg 			rs1 = fs->fs_regs[rs2];
    438   1.7       mrg 			goto mov;
    439   1.7       mrg 		case FMVRLZ >> 2:
    440  1.17   thorpej 			/* Presume we're curlwp */
    441   1.8       eeh 			DPRINTF(FPE_INSN, ("fpu_execute: FMVRLZ\n"));
    442   1.7       mrg 			rs1 = instr.i_fmovr.i_rs1;
    443  1.17   thorpej 			if (rs1 == 0 || (int64_t)curlwp->l_md.md_tf->tf_global[rs1] >= 0)
    444   1.7       mrg 				return (0); /* success */
    445   1.7       mrg 			rs1 = fs->fs_regs[rs2];
    446   1.7       mrg 			goto mov;
    447   1.7       mrg 		case FMVRNZ >> 2:
    448  1.17   thorpej 			/* Presume we're curlwp */
    449   1.8       eeh 			DPRINTF(FPE_INSN, ("fpu_execute: FMVRNZ\n"));
    450   1.7       mrg 			rs1 = instr.i_fmovr.i_rs1;
    451  1.17   thorpej 			if (rs1 == 0 || (int64_t)curlwp->l_md.md_tf->tf_global[rs1] == 0)
    452   1.7       mrg 				return (0); /* success */
    453   1.7       mrg 			rs1 = fs->fs_regs[rs2];
    454   1.7       mrg 			goto mov;
    455   1.7       mrg 		case FMVRGZ >> 2:
    456  1.17   thorpej 			/* Presume we're curlwp */
    457   1.8       eeh 			DPRINTF(FPE_INSN, ("fpu_execute: FMVRGZ\n"));
    458   1.7       mrg 			rs1 = instr.i_fmovr.i_rs1;
    459  1.17   thorpej 			if (rs1 == 0 || (int64_t)curlwp->l_md.md_tf->tf_global[rs1] <= 0)
    460   1.7       mrg 				return (0); /* success */
    461   1.7       mrg 			rs1 = fs->fs_regs[rs2];
    462   1.7       mrg 			goto mov;
    463   1.7       mrg 		case FMVRGEZ >> 2:
    464  1.17   thorpej 			/* Presume we're curlwp */
    465   1.8       eeh 			DPRINTF(FPE_INSN, ("fpu_execute: FMVRGEZ\n"));
    466   1.7       mrg 			rs1 = instr.i_fmovr.i_rs1;
    467  1.17   thorpej 			if (rs1 != 0 && (int64_t)curlwp->l_md.md_tf->tf_global[rs1] < 0)
    468   1.7       mrg 				return (0); /* success */
    469   1.7       mrg 			rs1 = fs->fs_regs[rs2];
    470   1.8       eeh 			goto mov;
    471   1.7       mrg 		default:
    472   1.8       eeh 			DPRINTF(FPE_INSN,
    473   1.8       eeh 				("fpu_execute: unknown v9 FP inst %x opf %x\n",
    474   1.8       eeh 					instr.i_int, opf));
    475   1.7       mrg 			return (NOTFPU);
    476   1.7       mrg 		}
    477   1.7       mrg 	}
    478   1.7       mrg #endif /* SUN4U */
    479   1.1   deraadt 	switch (opf >>= 2) {
    480   1.1   deraadt 
    481   1.1   deraadt 	default:
    482   1.8       eeh 		DPRINTF(FPE_INSN,
    483   1.8       eeh 			("fpu_execute: unknown basic FP inst %x opf %x\n",
    484   1.8       eeh 				instr.i_int, opf));
    485   1.1   deraadt 		return (NOTFPU);
    486   1.1   deraadt 
    487   1.1   deraadt 	case FMOV >> 2:		/* these should all be pretty obvious */
    488   1.8       eeh 		DPRINTF(FPE_INSN, ("fpu_execute: FMOV\n"));
    489   1.1   deraadt 		rs1 = fs->fs_regs[rs2];
    490   1.1   deraadt 		goto mov;
    491   1.1   deraadt 
    492   1.1   deraadt 	case FNEG >> 2:
    493   1.8       eeh 		DPRINTF(FPE_INSN, ("fpu_execute: FNEG\n"));
    494   1.1   deraadt 		rs1 = fs->fs_regs[rs2] ^ (1 << 31);
    495   1.1   deraadt 		goto mov;
    496   1.1   deraadt 
    497   1.1   deraadt 	case FABS >> 2:
    498   1.8       eeh 		DPRINTF(FPE_INSN, ("fpu_execute: FABS\n"));
    499   1.1   deraadt 		rs1 = fs->fs_regs[rs2] & ~(1 << 31);
    500   1.1   deraadt 	mov:
    501   1.7       mrg #ifndef SUN4U
    502   1.1   deraadt 		fs->fs_regs[rd] = rs1;
    503   1.7       mrg #else /* SUN4U */
    504  1.12       eeh 		i = 1<<(type-1);
    505   1.7       mrg 		fs->fs_regs[rd++] = rs1;
    506  1.12       eeh 		while (--i > 0)
    507   1.7       mrg 			fs->fs_regs[rd++] = fs->fs_regs[++rs2];
    508   1.7       mrg #endif /* SUN4U */
    509   1.1   deraadt 		fs->fs_fsr = fe->fe_fsr;
    510   1.1   deraadt 		return (0);	/* success */
    511   1.1   deraadt 
    512   1.1   deraadt 	case FSQRT >> 2:
    513   1.8       eeh 		DPRINTF(FPE_INSN, ("fpu_execute: FSQRT\n"));
    514   1.1   deraadt 		fpu_explode(fe, &fe->fe_f1, type, rs2);
    515   1.1   deraadt 		fp = fpu_sqrt(fe);
    516   1.1   deraadt 		break;
    517   1.1   deraadt 
    518   1.1   deraadt 	case FADD >> 2:
    519   1.8       eeh 		DPRINTF(FPE_INSN, ("fpu_execute: FADD\n"));
    520   1.1   deraadt 		fpu_explode(fe, &fe->fe_f1, type, rs1);
    521   1.1   deraadt 		fpu_explode(fe, &fe->fe_f2, type, rs2);
    522   1.1   deraadt 		fp = fpu_add(fe);
    523   1.1   deraadt 		break;
    524   1.1   deraadt 
    525   1.1   deraadt 	case FSUB >> 2:
    526   1.8       eeh 		DPRINTF(FPE_INSN, ("fpu_execute: FSUB\n"));
    527   1.1   deraadt 		fpu_explode(fe, &fe->fe_f1, type, rs1);
    528   1.1   deraadt 		fpu_explode(fe, &fe->fe_f2, type, rs2);
    529   1.1   deraadt 		fp = fpu_sub(fe);
    530   1.1   deraadt 		break;
    531   1.1   deraadt 
    532   1.1   deraadt 	case FMUL >> 2:
    533   1.8       eeh 		DPRINTF(FPE_INSN, ("fpu_execute: FMUL\n"));
    534   1.1   deraadt 		fpu_explode(fe, &fe->fe_f1, type, rs1);
    535   1.1   deraadt 		fpu_explode(fe, &fe->fe_f2, type, rs2);
    536   1.1   deraadt 		fp = fpu_mul(fe);
    537   1.1   deraadt 		break;
    538   1.1   deraadt 
    539   1.1   deraadt 	case FDIV >> 2:
    540   1.8       eeh 		DPRINTF(FPE_INSN, ("fpu_execute: FDIV\n"));
    541   1.1   deraadt 		fpu_explode(fe, &fe->fe_f1, type, rs1);
    542   1.1   deraadt 		fpu_explode(fe, &fe->fe_f2, type, rs2);
    543   1.1   deraadt 		fp = fpu_div(fe);
    544   1.1   deraadt 		break;
    545   1.1   deraadt 
    546   1.1   deraadt 	case FCMP >> 2:
    547   1.8       eeh 		DPRINTF(FPE_INSN, ("fpu_execute: FCMP\n"));
    548   1.1   deraadt 		fpu_explode(fe, &fe->fe_f1, type, rs1);
    549   1.1   deraadt 		fpu_explode(fe, &fe->fe_f2, type, rs2);
    550   1.1   deraadt 		fpu_compare(fe, 0);
    551   1.1   deraadt 		goto cmpdone;
    552   1.1   deraadt 
    553   1.1   deraadt 	case FCMPE >> 2:
    554   1.8       eeh 		DPRINTF(FPE_INSN, ("fpu_execute: FCMPE\n"));
    555   1.1   deraadt 		fpu_explode(fe, &fe->fe_f1, type, rs1);
    556   1.1   deraadt 		fpu_explode(fe, &fe->fe_f2, type, rs2);
    557   1.1   deraadt 		fpu_compare(fe, 1);
    558   1.1   deraadt 	cmpdone:
    559   1.1   deraadt 		/*
    560   1.1   deraadt 		 * The only possible exception here is NV; catch it
    561   1.1   deraadt 		 * early and get out, as there is no result register.
    562   1.1   deraadt 		 */
    563   1.1   deraadt 		cx = fe->fe_cx;
    564   1.1   deraadt 		fsr = fe->fe_fsr | (cx << FSR_CX_SHIFT);
    565   1.1   deraadt 		if (cx != 0) {
    566   1.1   deraadt 			if (fsr & (FSR_NV << FSR_TEM_SHIFT)) {
    567   1.1   deraadt 				fs->fs_fsr = (fsr & ~FSR_FTT) |
    568   1.1   deraadt 				    (FSR_TT_IEEE << FSR_FTT_SHIFT);
    569   1.1   deraadt 				return (FPE);
    570   1.1   deraadt 			}
    571   1.1   deraadt 			fsr |= FSR_NV << FSR_AX_SHIFT;
    572   1.1   deraadt 		}
    573   1.1   deraadt 		fs->fs_fsr = fsr;
    574   1.1   deraadt 		return (0);
    575   1.1   deraadt 
    576   1.1   deraadt 	case FSMULD >> 2:
    577   1.1   deraadt 	case FDMULX >> 2:
    578   1.8       eeh 		DPRINTF(FPE_INSN, ("fpu_execute: FSMULx\n"));
    579   1.1   deraadt 		if (type == FTYPE_EXT)
    580   1.1   deraadt 			return (NOTFPU);
    581   1.1   deraadt 		fpu_explode(fe, &fe->fe_f1, type, rs1);
    582   1.1   deraadt 		fpu_explode(fe, &fe->fe_f2, type, rs2);
    583   1.1   deraadt 		type++;	/* single to double, or double to quad */
    584   1.1   deraadt 		fp = fpu_mul(fe);
    585   1.1   deraadt 		break;
    586   1.1   deraadt 
    587   1.7       mrg #ifdef SUN4U
    588   1.7       mrg 	case FXTOS >> 2:
    589   1.7       mrg 	case FXTOD >> 2:
    590   1.7       mrg 	case FXTOQ >> 2:
    591   1.8       eeh 		DPRINTF(FPE_INSN, ("fpu_execute: FXTOx\n"));
    592   1.7       mrg 		type = FTYPE_LNG;
    593   1.7       mrg 		fpu_explode(fe, fp = &fe->fe_f1, type, rs2);
    594   1.7       mrg 		type = opf & 3;	/* sneaky; depends on instruction encoding */
    595   1.7       mrg 		break;
    596   1.7       mrg 
    597   1.7       mrg 	case FTOX >> 2:
    598  1.14       eeh 		DPRINTF(FPE_INSN, ("fpu_execute: FTOX\n"));
    599   1.7       mrg 		fpu_explode(fe, fp = &fe->fe_f1, type, rs2);
    600   1.7       mrg 		type = FTYPE_LNG;
    601  1.14       eeh 		/* Recalculate destination register */
    602  1.14       eeh 		rd = instr.i_opf.i_rd;
    603   1.8       eeh 		break;
    604  1.14       eeh 
    605   1.7       mrg #endif /* SUN4U */
    606  1.14       eeh 	case FTOI >> 2:
    607  1.14       eeh 		DPRINTF(FPE_INSN, ("fpu_execute: FTOI\n"));
    608  1.14       eeh 		fpu_explode(fe, fp = &fe->fe_f1, type, rs2);
    609  1.14       eeh 		type = FTYPE_INT;
    610  1.14       eeh 		/* Recalculate destination register */
    611  1.14       eeh 		rd = instr.i_opf.i_rd;
    612  1.14       eeh 		break;
    613   1.7       mrg 
    614   1.1   deraadt 	case FTOS >> 2:
    615   1.1   deraadt 	case FTOD >> 2:
    616   1.7       mrg 	case FTOQ >> 2:
    617   1.8       eeh 		DPRINTF(FPE_INSN, ("fpu_execute: FTOx\n"));
    618   1.1   deraadt 		fpu_explode(fe, fp = &fe->fe_f1, type, rs2);
    619  1.14       eeh 		/* Recalculate rd with correct type info. */
    620   1.1   deraadt 		type = opf & 3;	/* sneaky; depends on instruction encoding */
    621  1.14       eeh 		mask = 0x3 >> (3 - type);
    622  1.14       eeh 		rd = instr.i_opf.i_rd;
    623  1.14       eeh 		rd = (rd & ~mask) | ((rd & mask & 0x1) << 5);
    624   1.1   deraadt 		break;
    625   1.1   deraadt 	}
    626   1.1   deraadt 
    627   1.1   deraadt 	/*
    628   1.1   deraadt 	 * ALU operation is complete.  Collapse the result and then check
    629   1.1   deraadt 	 * for exceptions.  If we got any, and they are enabled, do not
    630   1.1   deraadt 	 * alter the destination register, just stop with an exception.
    631   1.1   deraadt 	 * Otherwise set new current exceptions and accrue.
    632   1.1   deraadt 	 */
    633   1.1   deraadt 	fpu_implode(fe, fp, type, space);
    634   1.1   deraadt 	cx = fe->fe_cx;
    635   1.1   deraadt 	fsr = fe->fe_fsr;
    636   1.1   deraadt 	if (cx != 0) {
    637   1.1   deraadt 		mask = (fsr >> FSR_TEM_SHIFT) & FSR_TEM_MASK;
    638   1.1   deraadt 		if (cx & mask) {
    639   1.1   deraadt 			/* not accrued??? */
    640   1.1   deraadt 			fs->fs_fsr = (fsr & ~FSR_FTT) |
    641   1.1   deraadt 			    (FSR_TT_IEEE << FSR_FTT_SHIFT) |
    642   1.1   deraadt 			    (cx_to_trapx[(cx & mask) - 1] << FSR_CX_SHIFT);
    643   1.1   deraadt 			return (FPE);
    644   1.1   deraadt 		}
    645   1.1   deraadt 		fsr |= (cx << FSR_CX_SHIFT) | (cx << FSR_AX_SHIFT);
    646   1.1   deraadt 	}
    647   1.1   deraadt 	fs->fs_fsr = fsr;
    648  1.14       eeh 	DPRINTF(FPE_REG, ("-> %c%d\n", (type == FTYPE_LNG) ? 'x' :
    649  1.14       eeh 		((type == FTYPE_INT) ? 'i' :
    650  1.14       eeh 			((type == FTYPE_SNG) ? 's' :
    651  1.14       eeh 				((type == FTYPE_DBL) ? 'd' :
    652  1.14       eeh 					((type == FTYPE_EXT) ? 'q' : '?')))),
    653  1.14       eeh 		rd));
    654   1.1   deraadt 	fs->fs_regs[rd] = space[0];
    655  1.10        pk 	if (type >= FTYPE_DBL || type == FTYPE_LNG) {
    656   1.1   deraadt 		fs->fs_regs[rd + 1] = space[1];
    657   1.1   deraadt 		if (type > FTYPE_DBL) {
    658   1.1   deraadt 			fs->fs_regs[rd + 2] = space[2];
    659   1.1   deraadt 			fs->fs_regs[rd + 3] = space[3];
    660   1.1   deraadt 		}
    661   1.1   deraadt 	}
    662   1.1   deraadt 	return (0);	/* success */
    663   1.1   deraadt }
    664