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