Home | History | Annotate | Line # | Download | only in fpu
fpu.c revision 1.26
      1  1.26     rmind /*	$NetBSD: fpu.c,v 1.26 2009/11/21 04:16:51 rmind 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.26     rmind __KERNEL_RCSID(0, "$NetBSD: fpu.c,v 1.26 2009/11/21 04:16:51 rmind 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.24  christos 	static const 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.25       uwe 		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.23        pk int
    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.23        pk 	int code = 0;
    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.23        pk 		code = fpu_codes[i - 1];
    163   1.1   deraadt 		break;		/* XXX should return, but queue remains */
    164   1.1   deraadt 
    165   1.1   deraadt 	case FSR_TT_UNFIN:
    166  1.14       eeh 		DPRINTF(FPE_INSN, ("fpu_cleanup: FSR_TT_UNFIN\n"));
    167   1.7       mrg #ifdef SUN4U
    168   1.7       mrg 		if (fs->fs_qsize == 0) {
    169   1.7       mrg 			printf("fpu_cleanup: unfinished fpop");
    170   1.7       mrg 			/* The book sez reexecute or emulate. */
    171  1.23        pk 			return (0);
    172   1.7       mrg 		}
    173   1.7       mrg 		break;
    174   1.7       mrg 
    175   1.7       mrg #endif /* SUN4U */
    176   1.1   deraadt 	case FSR_TT_UNIMP:
    177  1.14       eeh 		DPRINTF(FPE_INSN, ("fpu_cleanup: FSR_TT_UNIMP\n"));
    178   1.1   deraadt 		if (fs->fs_qsize == 0)
    179   1.7       mrg 			panic("fpu_cleanup: unimplemented fpop");
    180   1.1   deraadt 		break;
    181   1.1   deraadt 
    182   1.1   deraadt 	case FSR_TT_SEQ:
    183   1.1   deraadt 		panic("fpu sequence error");
    184   1.1   deraadt 		/* NOTREACHED */
    185   1.1   deraadt 
    186   1.1   deraadt 	case FSR_TT_HWERR:
    187  1.14       eeh 		DPRINTF(FPE_INSN, ("fpu_cleanup: FSR_TT_HWERR\n"));
    188   1.1   deraadt 		log(LOG_ERR, "fpu hardware error (%s[%d])\n",
    189   1.1   deraadt 		    p->p_comm, p->p_pid);
    190   1.1   deraadt 		uprintf("%s[%d]: fpu hardware error\n", p->p_comm, p->p_pid);
    191  1.23        pk 		code = SI_NOINFO;
    192   1.1   deraadt 		goto out;
    193   1.1   deraadt 
    194   1.1   deraadt 	default:
    195   1.6      fair 		printf("fsr=0x%x\n", fsr);
    196   1.1   deraadt 		panic("fpu error");
    197   1.1   deraadt 	}
    198   1.1   deraadt 
    199   1.1   deraadt 	/* emulate the instructions left in the queue */
    200   1.1   deraadt 	fe.fe_fpstate = fs;
    201   1.1   deraadt 	for (i = 0; i < fs->fs_qsize; i++) {
    202   1.1   deraadt 		instr.i_int = fs->fs_queue[i].fq_instr;
    203   1.1   deraadt 		if (instr.i_any.i_op != IOP_reg ||
    204   1.1   deraadt 		    (instr.i_op3.i_op3 != IOP3_FPop1 &&
    205   1.1   deraadt 		     instr.i_op3.i_op3 != IOP3_FPop2))
    206   1.1   deraadt 			panic("bogus fpu queue");
    207   1.1   deraadt 		error = fpu_execute(&fe, instr);
    208  1.16        pk 		if (error == 0)
    209   1.1   deraadt 			continue;
    210   1.1   deraadt 
    211  1.16        pk 		switch (error) {
    212   1.1   deraadt 		case FPE:
    213  1.23        pk 			code = fpu_codes[(fs->fs_fsr & FSR_CX) - 1];
    214   1.1   deraadt 			break;
    215   1.1   deraadt 
    216   1.1   deraadt 		case NOTFPU:
    217   1.7       mrg #ifdef SUN4U
    218   1.7       mrg #ifdef DEBUG
    219  1.11       mrg 			printf("fpu_cleanup: not an FPU error -- sending SIGILL\n");
    220   1.7       mrg #endif
    221   1.7       mrg #endif /* SUN4U */
    222  1.23        pk 			code = SI_NOINFO;
    223   1.1   deraadt 			break;
    224   1.1   deraadt 
    225   1.1   deraadt 		default:
    226   1.1   deraadt 			panic("fpu_cleanup 3");
    227   1.1   deraadt 			/* NOTREACHED */
    228   1.1   deraadt 		}
    229   1.1   deraadt 		/* XXX should stop here, but queue remains */
    230   1.1   deraadt 	}
    231   1.1   deraadt out:
    232   1.1   deraadt 	fs->fs_qsize = 0;
    233  1.23        pk 	return (code);
    234   1.1   deraadt }
    235   1.1   deraadt 
    236   1.1   deraadt #ifdef notyet
    237   1.1   deraadt /*
    238   1.1   deraadt  * If we have no FPU at all (are there any machines like this out
    239   1.1   deraadt  * there!?) we have to emulate each instruction, and we need a pointer
    240   1.1   deraadt  * to the trapframe so that we can step over them and do FBfcc's.
    241   1.1   deraadt  * We know the `queue' is empty, though; we just want to emulate
    242   1.1   deraadt  * the instruction at tf->tf_pc.
    243   1.1   deraadt  */
    244  1.17   thorpej fpu_emulate(l, tf, fs)
    245  1.17   thorpej 	struct lwp *l;
    246  1.21        pk 	struct trapframe *tf;
    247   1.7       mrg #ifndef SUN4U
    248  1.21        pk 	struct fpstate *fs;
    249   1.7       mrg #else /* SUN4U */
    250  1.21        pk 	struct fpstate64 *fs;
    251   1.7       mrg #endif /* SUN4U */
    252   1.1   deraadt {
    253   1.1   deraadt 
    254   1.1   deraadt 	do {
    255   1.1   deraadt 		fetch instr from pc
    256   1.1   deraadt 		decode
    257   1.1   deraadt 		if (integer instr) {
    258  1.26     rmind 			struct pcb *pcb = lwp_getpcb(l);
    259   1.1   deraadt 			/*
    260   1.1   deraadt 			 * We do this here, rather than earlier, to avoid
    261   1.1   deraadt 			 * losing even more badly than usual.
    262   1.1   deraadt 			 */
    263  1.26     rmind 			if (pcb->pcb_uw) {
    264   1.1   deraadt 				write_user_windows();
    265  1.17   thorpej 				if (rwindow_save(l))
    266  1.17   thorpej 					sigexit(l, SIGILL);
    267   1.1   deraadt 			}
    268   1.1   deraadt 			if (loadstore) {
    269   1.1   deraadt 				do_it;
    270   1.1   deraadt 				pc = npc, npc += 4
    271   1.1   deraadt 			} else if (fbfcc) {
    272   1.1   deraadt 				do_annul_stuff;
    273   1.1   deraadt 			} else
    274   1.1   deraadt 				return;
    275   1.1   deraadt 		} else if (fpu instr) {
    276   1.1   deraadt 			fe.fe_fsr = fs->fs_fsr &= ~FSR_CX;
    277   1.1   deraadt 			error = fpu_execute(&fe, fs, instr);
    278   1.1   deraadt 			switch (error) {
    279   1.1   deraadt 				etc;
    280   1.1   deraadt 			}
    281   1.1   deraadt 		} else
    282   1.1   deraadt 			return;
    283   1.1   deraadt 		if (want to reschedule)
    284   1.1   deraadt 			return;
    285   1.1   deraadt 	} while (error == 0);
    286   1.1   deraadt }
    287   1.1   deraadt #endif
    288   1.1   deraadt 
    289   1.1   deraadt /*
    290   1.1   deraadt  * Execute an FPU instruction (one that runs entirely in the FPU; not
    291   1.1   deraadt  * FBfcc or STF, for instance).  On return, fe->fe_fs->fs_fsr will be
    292   1.1   deraadt  * modified to reflect the setting the hardware would have left.
    293   1.1   deraadt  *
    294   1.1   deraadt  * Note that we do not catch all illegal opcodes, so you can, for instance,
    295   1.1   deraadt  * multiply two integers this way.
    296   1.1   deraadt  */
    297   1.1   deraadt int
    298  1.25       uwe fpu_execute(struct fpemu *fe, union instr instr)
    299   1.1   deraadt {
    300  1.21        pk 	struct fpn *fp;
    301   1.7       mrg #ifndef SUN4U
    302  1.21        pk 	int opf, rs1, rs2, rd, type, mask, fsr, cx;
    303  1.21        pk 	struct fpstate *fs;
    304   1.7       mrg #else /* SUN4U */
    305  1.21        pk 	int opf, rs1, rs2, rd, type, mask, fsr, cx, i, cond;
    306  1.21        pk 	struct fpstate64 *fs;
    307   1.7       mrg #endif /* SUN4U */
    308   1.1   deraadt 	u_int space[4];
    309  1.14       eeh 
    310   1.1   deraadt 	/*
    311   1.1   deraadt 	 * `Decode' and execute instruction.  Start with no exceptions.
    312   1.1   deraadt 	 * The type of any i_opf opcode is in the bottom two bits, so we
    313   1.1   deraadt 	 * squish them out here.
    314   1.1   deraadt 	 */
    315   1.1   deraadt 	opf = instr.i_opf.i_opf;
    316  1.12       eeh 	/*
    317  1.12       eeh 	 * The low two bits of the opf field for floating point insns usually
    318  1.12       eeh 	 * correspond to the operation width:
    319  1.12       eeh 	 *
    320  1.12       eeh 	 *	0:	Invalid
    321  1.12       eeh 	 *	1:	Single precision float
    322  1.12       eeh 	 *	2:	Double precision float
    323  1.12       eeh 	 *	3:	Quad precision float
    324  1.12       eeh 	 *
    325  1.12       eeh 	 * The exceptions are the integer to float conversion instructions.
    326  1.12       eeh 	 *
    327  1.12       eeh 	 * For double and quad precision, the low bit if the rs or rd field
    328  1.12       eeh 	 * is actually the high bit of the register number.
    329  1.12       eeh 	 */
    330  1.12       eeh 
    331   1.1   deraadt 	type = opf & 3;
    332  1.12       eeh 	mask = 0x3 >> (3 - type);
    333  1.12       eeh 
    334  1.12       eeh 	rs1 = instr.i_opf.i_rs1;
    335  1.12       eeh 	rs1 = (rs1 & ~mask) | ((rs1 & mask & 0x1) << 5);
    336  1.12       eeh 	rs2 = instr.i_opf.i_rs2;
    337  1.12       eeh 	rs2 = (rs2 & ~mask) | ((rs2 & mask & 0x1) << 5);
    338  1.12       eeh 	rd = instr.i_opf.i_rd;
    339  1.12       eeh 	rd = (rd & ~mask) | ((rd & mask & 0x1) << 5);
    340  1.12       eeh #ifdef DIAGNOSTIC
    341   1.1   deraadt 	if ((rs1 | rs2 | rd) & mask)
    342  1.13       eeh 		/* This may be an FPU insn but it is illegal. */
    343  1.13       eeh 		return (NOTFPU);
    344   1.1   deraadt #endif
    345   1.1   deraadt 	fs = fe->fe_fpstate;
    346   1.1   deraadt 	fe->fe_fsr = fs->fs_fsr & ~FSR_CX;
    347   1.1   deraadt 	fe->fe_cx = 0;
    348   1.7       mrg #ifdef SUN4U
    349   1.7       mrg 	/*
    350   1.7       mrg 	 * Check to see if we're dealing with a fancy cmove and handle
    351  1.25       uwe 	 * it first.
    352   1.7       mrg 	 */
    353   1.7       mrg 	if (instr.i_op3.i_op3 == IOP3_FPop2 && (opf&0xff0) != (FCMP&0xff0)) {
    354   1.7       mrg 		switch (opf >>= 2) {
    355   1.7       mrg 		case FMVFC0 >> 2:
    356   1.8       eeh 			DPRINTF(FPE_INSN, ("fpu_execute: FMVFC0\n"));
    357   1.7       mrg 			cond = (fs->fs_fsr>>FSR_FCC_SHIFT)&FSR_FCC_MASK;
    358   1.7       mrg 			if (instr.i_fmovcc.i_cond != cond) return(0); /* success */
    359   1.7       mrg 			rs1 = fs->fs_regs[rs2];
    360   1.7       mrg 			goto mov;
    361   1.7       mrg 		case FMVFC1 >> 2:
    362   1.8       eeh 			DPRINTF(FPE_INSN, ("fpu_execute: FMVFC1\n"));
    363   1.7       mrg 			cond = (fs->fs_fsr>>FSR_FCC1_SHIFT)&FSR_FCC_MASK;
    364   1.7       mrg 			if (instr.i_fmovcc.i_cond != cond) return(0); /* success */
    365   1.7       mrg 			rs1 = fs->fs_regs[rs2];
    366   1.7       mrg 			goto mov;
    367   1.7       mrg 		case FMVFC2 >> 2:
    368   1.8       eeh 			DPRINTF(FPE_INSN, ("fpu_execute: FMVFC2\n"));
    369   1.7       mrg 			cond = (fs->fs_fsr>>FSR_FCC2_SHIFT)&FSR_FCC_MASK;
    370   1.7       mrg 			if (instr.i_fmovcc.i_cond != cond) return(0); /* success */
    371   1.7       mrg 			rs1 = fs->fs_regs[rs2];
    372   1.7       mrg 			goto mov;
    373   1.7       mrg 		case FMVFC3 >> 2:
    374   1.8       eeh 			DPRINTF(FPE_INSN, ("fpu_execute: FMVFC3\n"));
    375   1.7       mrg 			cond = (fs->fs_fsr>>FSR_FCC3_SHIFT)&FSR_FCC_MASK;
    376   1.7       mrg 			if (instr.i_fmovcc.i_cond != cond) return(0); /* success */
    377   1.7       mrg 			rs1 = fs->fs_regs[rs2];
    378   1.7       mrg 			goto mov;
    379   1.7       mrg 		case FMVIC >> 2:
    380  1.17   thorpej 			/* Presume we're curlwp */
    381   1.8       eeh 			DPRINTF(FPE_INSN, ("fpu_execute: FMVIC\n"));
    382  1.17   thorpej 			cond = (curlwp->l_md.md_tf->tf_tstate>>TSTATE_CCR_SHIFT)&PSR_ICC;
    383   1.7       mrg 			if (instr.i_fmovcc.i_cond != cond) return(0); /* success */
    384   1.7       mrg 			rs1 = fs->fs_regs[rs2];
    385  1.25       uwe 			goto mov;
    386   1.7       mrg 		case FMVXC >> 2:
    387  1.17   thorpej 			/* Presume we're curlwp */
    388   1.8       eeh 			DPRINTF(FPE_INSN, ("fpu_execute: FMVXC\n"));
    389  1.17   thorpej 			cond = (curlwp->l_md.md_tf->tf_tstate>>(TSTATE_CCR_SHIFT+XCC_SHIFT))&PSR_ICC;
    390   1.7       mrg 			if (instr.i_fmovcc.i_cond != cond) return(0); /* success */
    391   1.7       mrg 			rs1 = fs->fs_regs[rs2];
    392  1.25       uwe 			goto mov;
    393   1.7       mrg 		case FMVRZ >> 2:
    394  1.17   thorpej 			/* Presume we're curlwp */
    395   1.8       eeh 			DPRINTF(FPE_INSN, ("fpu_execute: FMVRZ\n"));
    396   1.7       mrg 			rs1 = instr.i_fmovr.i_rs1;
    397  1.17   thorpej 			if (rs1 != 0 && (int64_t)curlwp->l_md.md_tf->tf_global[rs1] != 0)
    398   1.7       mrg 				return (0); /* success */
    399   1.7       mrg 			rs1 = fs->fs_regs[rs2];
    400  1.25       uwe 			goto mov;
    401   1.7       mrg 		case FMVRLEZ >> 2:
    402  1.17   thorpej 			/* Presume we're curlwp */
    403   1.8       eeh 			DPRINTF(FPE_INSN, ("fpu_execute: FMVRLEZ\n"));
    404   1.7       mrg 			rs1 = instr.i_fmovr.i_rs1;
    405  1.17   thorpej 			if (rs1 != 0 && (int64_t)curlwp->l_md.md_tf->tf_global[rs1] > 0)
    406   1.7       mrg 				return (0); /* success */
    407   1.7       mrg 			rs1 = fs->fs_regs[rs2];
    408  1.25       uwe 			goto mov;
    409   1.7       mrg 		case FMVRLZ >> 2:
    410  1.17   thorpej 			/* Presume we're curlwp */
    411   1.8       eeh 			DPRINTF(FPE_INSN, ("fpu_execute: FMVRLZ\n"));
    412   1.7       mrg 			rs1 = instr.i_fmovr.i_rs1;
    413  1.17   thorpej 			if (rs1 == 0 || (int64_t)curlwp->l_md.md_tf->tf_global[rs1] >= 0)
    414   1.7       mrg 				return (0); /* success */
    415   1.7       mrg 			rs1 = fs->fs_regs[rs2];
    416  1.25       uwe 			goto mov;
    417   1.7       mrg 		case FMVRNZ >> 2:
    418  1.17   thorpej 			/* Presume we're curlwp */
    419   1.8       eeh 			DPRINTF(FPE_INSN, ("fpu_execute: FMVRNZ\n"));
    420   1.7       mrg 			rs1 = instr.i_fmovr.i_rs1;
    421  1.17   thorpej 			if (rs1 == 0 || (int64_t)curlwp->l_md.md_tf->tf_global[rs1] == 0)
    422   1.7       mrg 				return (0); /* success */
    423   1.7       mrg 			rs1 = fs->fs_regs[rs2];
    424  1.25       uwe 			goto mov;
    425   1.7       mrg 		case FMVRGZ >> 2:
    426  1.17   thorpej 			/* Presume we're curlwp */
    427   1.8       eeh 			DPRINTF(FPE_INSN, ("fpu_execute: FMVRGZ\n"));
    428   1.7       mrg 			rs1 = instr.i_fmovr.i_rs1;
    429  1.17   thorpej 			if (rs1 == 0 || (int64_t)curlwp->l_md.md_tf->tf_global[rs1] <= 0)
    430   1.7       mrg 				return (0); /* success */
    431   1.7       mrg 			rs1 = fs->fs_regs[rs2];
    432  1.25       uwe 			goto mov;
    433   1.7       mrg 		case FMVRGEZ >> 2:
    434  1.17   thorpej 			/* Presume we're curlwp */
    435   1.8       eeh 			DPRINTF(FPE_INSN, ("fpu_execute: FMVRGEZ\n"));
    436   1.7       mrg 			rs1 = instr.i_fmovr.i_rs1;
    437  1.17   thorpej 			if (rs1 != 0 && (int64_t)curlwp->l_md.md_tf->tf_global[rs1] < 0)
    438   1.7       mrg 				return (0); /* success */
    439   1.7       mrg 			rs1 = fs->fs_regs[rs2];
    440  1.25       uwe 			goto mov;
    441   1.7       mrg 		default:
    442  1.25       uwe 			DPRINTF(FPE_INSN,
    443  1.25       uwe 				("fpu_execute: unknown v9 FP inst %x opf %x\n",
    444   1.8       eeh 					instr.i_int, opf));
    445   1.7       mrg 			return (NOTFPU);
    446   1.7       mrg 		}
    447   1.7       mrg 	}
    448   1.7       mrg #endif /* SUN4U */
    449   1.1   deraadt 	switch (opf >>= 2) {
    450   1.1   deraadt 
    451   1.1   deraadt 	default:
    452  1.25       uwe 		DPRINTF(FPE_INSN,
    453   1.8       eeh 			("fpu_execute: unknown basic FP inst %x opf %x\n",
    454   1.8       eeh 				instr.i_int, opf));
    455   1.1   deraadt 		return (NOTFPU);
    456   1.1   deraadt 
    457   1.1   deraadt 	case FMOV >> 2:		/* these should all be pretty obvious */
    458   1.8       eeh 		DPRINTF(FPE_INSN, ("fpu_execute: FMOV\n"));
    459   1.1   deraadt 		rs1 = fs->fs_regs[rs2];
    460   1.1   deraadt 		goto mov;
    461   1.1   deraadt 
    462   1.1   deraadt 	case FNEG >> 2:
    463   1.8       eeh 		DPRINTF(FPE_INSN, ("fpu_execute: FNEG\n"));
    464   1.1   deraadt 		rs1 = fs->fs_regs[rs2] ^ (1 << 31);
    465   1.1   deraadt 		goto mov;
    466   1.1   deraadt 
    467   1.1   deraadt 	case FABS >> 2:
    468   1.8       eeh 		DPRINTF(FPE_INSN, ("fpu_execute: FABS\n"));
    469   1.1   deraadt 		rs1 = fs->fs_regs[rs2] & ~(1 << 31);
    470   1.1   deraadt 	mov:
    471   1.7       mrg #ifndef SUN4U
    472   1.1   deraadt 		fs->fs_regs[rd] = rs1;
    473   1.7       mrg #else /* SUN4U */
    474  1.12       eeh 		i = 1<<(type-1);
    475   1.7       mrg 		fs->fs_regs[rd++] = rs1;
    476  1.25       uwe 		while (--i > 0)
    477   1.7       mrg 			fs->fs_regs[rd++] = fs->fs_regs[++rs2];
    478   1.7       mrg #endif /* SUN4U */
    479   1.1   deraadt 		fs->fs_fsr = fe->fe_fsr;
    480   1.1   deraadt 		return (0);	/* success */
    481   1.1   deraadt 
    482   1.1   deraadt 	case FSQRT >> 2:
    483   1.8       eeh 		DPRINTF(FPE_INSN, ("fpu_execute: FSQRT\n"));
    484   1.1   deraadt 		fpu_explode(fe, &fe->fe_f1, type, rs2);
    485   1.1   deraadt 		fp = fpu_sqrt(fe);
    486   1.1   deraadt 		break;
    487   1.1   deraadt 
    488   1.1   deraadt 	case FADD >> 2:
    489   1.8       eeh 		DPRINTF(FPE_INSN, ("fpu_execute: FADD\n"));
    490   1.1   deraadt 		fpu_explode(fe, &fe->fe_f1, type, rs1);
    491   1.1   deraadt 		fpu_explode(fe, &fe->fe_f2, type, rs2);
    492   1.1   deraadt 		fp = fpu_add(fe);
    493   1.1   deraadt 		break;
    494   1.1   deraadt 
    495   1.1   deraadt 	case FSUB >> 2:
    496   1.8       eeh 		DPRINTF(FPE_INSN, ("fpu_execute: FSUB\n"));
    497   1.1   deraadt 		fpu_explode(fe, &fe->fe_f1, type, rs1);
    498   1.1   deraadt 		fpu_explode(fe, &fe->fe_f2, type, rs2);
    499   1.1   deraadt 		fp = fpu_sub(fe);
    500   1.1   deraadt 		break;
    501   1.1   deraadt 
    502   1.1   deraadt 	case FMUL >> 2:
    503   1.8       eeh 		DPRINTF(FPE_INSN, ("fpu_execute: FMUL\n"));
    504   1.1   deraadt 		fpu_explode(fe, &fe->fe_f1, type, rs1);
    505   1.1   deraadt 		fpu_explode(fe, &fe->fe_f2, type, rs2);
    506   1.1   deraadt 		fp = fpu_mul(fe);
    507   1.1   deraadt 		break;
    508   1.1   deraadt 
    509   1.1   deraadt 	case FDIV >> 2:
    510   1.8       eeh 		DPRINTF(FPE_INSN, ("fpu_execute: FDIV\n"));
    511   1.1   deraadt 		fpu_explode(fe, &fe->fe_f1, type, rs1);
    512   1.1   deraadt 		fpu_explode(fe, &fe->fe_f2, type, rs2);
    513   1.1   deraadt 		fp = fpu_div(fe);
    514   1.1   deraadt 		break;
    515   1.1   deraadt 
    516   1.1   deraadt 	case FCMP >> 2:
    517   1.8       eeh 		DPRINTF(FPE_INSN, ("fpu_execute: FCMP\n"));
    518   1.1   deraadt 		fpu_explode(fe, &fe->fe_f1, type, rs1);
    519   1.1   deraadt 		fpu_explode(fe, &fe->fe_f2, type, rs2);
    520   1.1   deraadt 		fpu_compare(fe, 0);
    521   1.1   deraadt 		goto cmpdone;
    522   1.1   deraadt 
    523   1.1   deraadt 	case FCMPE >> 2:
    524   1.8       eeh 		DPRINTF(FPE_INSN, ("fpu_execute: FCMPE\n"));
    525   1.1   deraadt 		fpu_explode(fe, &fe->fe_f1, type, rs1);
    526   1.1   deraadt 		fpu_explode(fe, &fe->fe_f2, type, rs2);
    527   1.1   deraadt 		fpu_compare(fe, 1);
    528   1.1   deraadt 	cmpdone:
    529   1.1   deraadt 		/*
    530   1.1   deraadt 		 * The only possible exception here is NV; catch it
    531   1.1   deraadt 		 * early and get out, as there is no result register.
    532   1.1   deraadt 		 */
    533   1.1   deraadt 		cx = fe->fe_cx;
    534   1.1   deraadt 		fsr = fe->fe_fsr | (cx << FSR_CX_SHIFT);
    535   1.1   deraadt 		if (cx != 0) {
    536   1.1   deraadt 			if (fsr & (FSR_NV << FSR_TEM_SHIFT)) {
    537   1.1   deraadt 				fs->fs_fsr = (fsr & ~FSR_FTT) |
    538   1.1   deraadt 				    (FSR_TT_IEEE << FSR_FTT_SHIFT);
    539   1.1   deraadt 				return (FPE);
    540   1.1   deraadt 			}
    541   1.1   deraadt 			fsr |= FSR_NV << FSR_AX_SHIFT;
    542   1.1   deraadt 		}
    543   1.1   deraadt 		fs->fs_fsr = fsr;
    544   1.1   deraadt 		return (0);
    545   1.1   deraadt 
    546   1.1   deraadt 	case FSMULD >> 2:
    547   1.1   deraadt 	case FDMULX >> 2:
    548   1.8       eeh 		DPRINTF(FPE_INSN, ("fpu_execute: FSMULx\n"));
    549   1.1   deraadt 		if (type == FTYPE_EXT)
    550   1.1   deraadt 			return (NOTFPU);
    551   1.1   deraadt 		fpu_explode(fe, &fe->fe_f1, type, rs1);
    552   1.1   deraadt 		fpu_explode(fe, &fe->fe_f2, type, rs2);
    553   1.1   deraadt 		type++;	/* single to double, or double to quad */
    554   1.1   deraadt 		fp = fpu_mul(fe);
    555   1.1   deraadt 		break;
    556   1.1   deraadt 
    557   1.7       mrg #ifdef SUN4U
    558   1.7       mrg 	case FXTOS >> 2:
    559   1.7       mrg 	case FXTOD >> 2:
    560   1.7       mrg 	case FXTOQ >> 2:
    561   1.8       eeh 		DPRINTF(FPE_INSN, ("fpu_execute: FXTOx\n"));
    562   1.7       mrg 		type = FTYPE_LNG;
    563   1.7       mrg 		fpu_explode(fe, fp = &fe->fe_f1, type, rs2);
    564   1.7       mrg 		type = opf & 3;	/* sneaky; depends on instruction encoding */
    565   1.7       mrg 		break;
    566   1.7       mrg 
    567   1.7       mrg 	case FTOX >> 2:
    568  1.14       eeh 		DPRINTF(FPE_INSN, ("fpu_execute: FTOX\n"));
    569   1.7       mrg 		fpu_explode(fe, fp = &fe->fe_f1, type, rs2);
    570   1.7       mrg 		type = FTYPE_LNG;
    571  1.14       eeh 		/* Recalculate destination register */
    572  1.14       eeh 		rd = instr.i_opf.i_rd;
    573   1.8       eeh 		break;
    574  1.14       eeh 
    575   1.7       mrg #endif /* SUN4U */
    576  1.14       eeh 	case FTOI >> 2:
    577  1.14       eeh 		DPRINTF(FPE_INSN, ("fpu_execute: FTOI\n"));
    578  1.14       eeh 		fpu_explode(fe, fp = &fe->fe_f1, type, rs2);
    579  1.14       eeh 		type = FTYPE_INT;
    580  1.14       eeh 		/* Recalculate destination register */
    581  1.14       eeh 		rd = instr.i_opf.i_rd;
    582  1.14       eeh 		break;
    583   1.7       mrg 
    584   1.1   deraadt 	case FTOS >> 2:
    585   1.1   deraadt 	case FTOD >> 2:
    586   1.7       mrg 	case FTOQ >> 2:
    587   1.8       eeh 		DPRINTF(FPE_INSN, ("fpu_execute: FTOx\n"));
    588   1.1   deraadt 		fpu_explode(fe, fp = &fe->fe_f1, type, rs2);
    589  1.14       eeh 		/* Recalculate rd with correct type info. */
    590   1.1   deraadt 		type = opf & 3;	/* sneaky; depends on instruction encoding */
    591  1.14       eeh 		mask = 0x3 >> (3 - type);
    592  1.14       eeh 		rd = instr.i_opf.i_rd;
    593  1.14       eeh 		rd = (rd & ~mask) | ((rd & mask & 0x1) << 5);
    594   1.1   deraadt 		break;
    595   1.1   deraadt 	}
    596   1.1   deraadt 
    597   1.1   deraadt 	/*
    598   1.1   deraadt 	 * ALU operation is complete.  Collapse the result and then check
    599   1.1   deraadt 	 * for exceptions.  If we got any, and they are enabled, do not
    600   1.1   deraadt 	 * alter the destination register, just stop with an exception.
    601   1.1   deraadt 	 * Otherwise set new current exceptions and accrue.
    602   1.1   deraadt 	 */
    603   1.1   deraadt 	fpu_implode(fe, fp, type, space);
    604   1.1   deraadt 	cx = fe->fe_cx;
    605   1.1   deraadt 	fsr = fe->fe_fsr;
    606   1.1   deraadt 	if (cx != 0) {
    607   1.1   deraadt 		mask = (fsr >> FSR_TEM_SHIFT) & FSR_TEM_MASK;
    608   1.1   deraadt 		if (cx & mask) {
    609   1.1   deraadt 			/* not accrued??? */
    610   1.1   deraadt 			fs->fs_fsr = (fsr & ~FSR_FTT) |
    611   1.1   deraadt 			    (FSR_TT_IEEE << FSR_FTT_SHIFT) |
    612   1.1   deraadt 			    (cx_to_trapx[(cx & mask) - 1] << FSR_CX_SHIFT);
    613   1.1   deraadt 			return (FPE);
    614   1.1   deraadt 		}
    615   1.1   deraadt 		fsr |= (cx << FSR_CX_SHIFT) | (cx << FSR_AX_SHIFT);
    616   1.1   deraadt 	}
    617   1.1   deraadt 	fs->fs_fsr = fsr;
    618  1.14       eeh 	DPRINTF(FPE_REG, ("-> %c%d\n", (type == FTYPE_LNG) ? 'x' :
    619  1.14       eeh 		((type == FTYPE_INT) ? 'i' :
    620  1.14       eeh 			((type == FTYPE_SNG) ? 's' :
    621  1.14       eeh 				((type == FTYPE_DBL) ? 'd' :
    622  1.14       eeh 					((type == FTYPE_EXT) ? 'q' : '?')))),
    623  1.14       eeh 		rd));
    624   1.1   deraadt 	fs->fs_regs[rd] = space[0];
    625  1.10        pk 	if (type >= FTYPE_DBL || type == FTYPE_LNG) {
    626   1.1   deraadt 		fs->fs_regs[rd + 1] = space[1];
    627   1.1   deraadt 		if (type > FTYPE_DBL) {
    628   1.1   deraadt 			fs->fs_regs[rd + 2] = space[2];
    629   1.1   deraadt 			fs->fs_regs[rd + 3] = space[3];
    630   1.1   deraadt 		}
    631   1.1   deraadt 	}
    632   1.1   deraadt 	return (0);	/* success */
    633   1.1   deraadt }
    634