Annotation of sys/arch/sparc/fpu/fpu.c, Revision 1.1
1.1 ! nbrk 1: /* $OpenBSD: fpu.c,v 1.12 2006/05/14 21:58:05 kettenis Exp $ */
! 2: /* $NetBSD: fpu.c,v 1.6 1997/07/29 10:09:51 fair Exp $ */
! 3:
! 4: /*
! 5: * Copyright (c) 1992, 1993
! 6: * The Regents of the University of California. All rights reserved.
! 7: *
! 8: * This software was developed by the Computer Systems Engineering group
! 9: * at Lawrence Berkeley Laboratory under DARPA contract BG 91-66 and
! 10: * contributed to Berkeley.
! 11: *
! 12: * All advertising materials mentioning features or use of this software
! 13: * must display the following acknowledgement:
! 14: * This product includes software developed by the University of
! 15: * California, Lawrence Berkeley Laboratory.
! 16: *
! 17: * Redistribution and use in source and binary forms, with or without
! 18: * modification, are permitted provided that the following conditions
! 19: * are met:
! 20: * 1. Redistributions of source code must retain the above copyright
! 21: * notice, this list of conditions and the following disclaimer.
! 22: * 2. Redistributions in binary form must reproduce the above copyright
! 23: * notice, this list of conditions and the following disclaimer in the
! 24: * documentation and/or other materials provided with the distribution.
! 25: * 3. Neither the name of the University nor the names of its contributors
! 26: * may be used to endorse or promote products derived from this software
! 27: * without specific prior written permission.
! 28: *
! 29: * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
! 30: * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
! 31: * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
! 32: * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
! 33: * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
! 34: * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
! 35: * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
! 36: * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
! 37: * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
! 38: * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
! 39: * SUCH DAMAGE.
! 40: *
! 41: * @(#)fpu.c 8.1 (Berkeley) 6/11/93
! 42: */
! 43:
! 44: #include <sys/param.h>
! 45: #include <sys/proc.h>
! 46: #include <sys/signal.h>
! 47: #include <sys/systm.h>
! 48: #include <sys/syslog.h>
! 49: #include <sys/signalvar.h>
! 50:
! 51: #include <machine/instr.h>
! 52: #include <machine/reg.h>
! 53:
! 54: #include <sparc/fpu/fpu_emu.h>
! 55: #include <sparc/fpu/fpu_extern.h>
! 56:
! 57: /*
! 58: * fpu_execute returns the following error numbers (0 = no error):
! 59: */
! 60: #define FPE 1 /* take a floating point exception */
! 61: #define NOTFPU 2 /* not an FPU instruction */
! 62:
! 63: /*
! 64: * Translate current exceptions into `first' exception. The
! 65: * bits go the wrong way for ffs() (0x10 is most important, etc).
! 66: * There are only 5, so do it the obvious way.
! 67: */
! 68: #define X1(x) x
! 69: #define X2(x) x,x
! 70: #define X4(x) x,x,x,x
! 71: #define X8(x) X4(x),X4(x)
! 72: #define X16(x) X8(x),X8(x)
! 73:
! 74: static char cx_to_trapx[] = {
! 75: X1(FSR_NX),
! 76: X2(FSR_DZ),
! 77: X4(FSR_UF),
! 78: X8(FSR_OF),
! 79: X16(FSR_NV)
! 80: };
! 81: static u_char fpu_codes[] = {
! 82: X1(FPE_FLTINEX_TRAP),
! 83: X2(FPE_FLTDIV_TRAP),
! 84: X4(FPE_FLTUND_TRAP),
! 85: X8(FPE_FLTOVF_TRAP),
! 86: X16(FPE_FLTOPERR_TRAP)
! 87: };
! 88:
! 89: static int fpu_types[] = {
! 90: X1(FPE_FLTRES),
! 91: X2(FPE_FLTDIV),
! 92: X4(FPE_FLTUND),
! 93: X8(FPE_FLTOVF),
! 94: X16(FPE_FLTINV)
! 95: };
! 96:
! 97: /*
! 98: * The FPU gave us an exception. Clean up the mess. Note that the
! 99: * fp queue can only have FPops in it, never load/store FP registers
! 100: * nor FBfcc instructions. Experiments with `crashme' prove that
! 101: * unknown FPops do enter the queue, however.
! 102: */
! 103: void
! 104: fpu_cleanup(p, fs)
! 105: register struct proc *p;
! 106: register struct fpstate *fs;
! 107: {
! 108: register int i, fsr = fs->fs_fsr, error;
! 109: union instr instr;
! 110: union sigval sv;
! 111: struct fpemu fe;
! 112:
! 113: sv.sival_int = p->p_md.md_tf->tf_pc; /* XXX only approximate */
! 114:
! 115: switch ((fsr >> FSR_FTT_SHIFT) & FSR_FTT_MASK) {
! 116:
! 117: case FSR_TT_NONE:
! 118: #if 0
! 119: /* XXX I'm not sure how we get here, but ignoring the trap */
! 120: /* XXX seems to work in my limited tests */
! 121: /* XXX More research to be done =) */
! 122: panic("fpu_cleanup 1"); /* ??? */
! 123: #else
! 124: printf("fpu_cleanup 1\n");
! 125: #endif
! 126: break;
! 127:
! 128: case FSR_TT_IEEE:
! 129: if ((i = fsr & FSR_CX) == 0)
! 130: panic("fpu ieee trap, but no exception");
! 131: trapsignal(p, SIGFPE, fpu_codes[i - 1], fpu_types[i - 1], sv);
! 132: break; /* XXX should return, but queue remains */
! 133:
! 134: case FSR_TT_UNFIN:
! 135: case FSR_TT_UNIMP:
! 136: if (fs->fs_qsize == 0)
! 137: panic("fpu_cleanup 2");
! 138: break;
! 139:
! 140: case FSR_TT_SEQ:
! 141: panic("fpu sequence error");
! 142: /* NOTREACHED */
! 143:
! 144: case FSR_TT_HWERR:
! 145: log(LOG_ERR, "fpu hardware error (%s[%d])\n",
! 146: p->p_comm, p->p_pid);
! 147: uprintf("%s[%d]: fpu hardware error\n", p->p_comm, p->p_pid);
! 148: trapsignal(p, SIGFPE, -1, FPE_FLTINV, sv); /* ??? */
! 149: goto out;
! 150:
! 151: default:
! 152: printf("fsr=0x%x\n", fsr);
! 153: panic("fpu error");
! 154: }
! 155:
! 156: /* emulate the instructions left in the queue */
! 157: fe.fe_fpstate = fs;
! 158: for (i = 0; i < fs->fs_qsize; i++) {
! 159: instr.i_int = fs->fs_queue[i].fq_instr;
! 160: if (instr.i_any.i_op != IOP_reg ||
! 161: (instr.i_op3.i_op3 != IOP3_FPop1 &&
! 162: instr.i_op3.i_op3 != IOP3_FPop2))
! 163: panic("bogus fpu queue");
! 164: error = fpu_execute(&fe, instr);
! 165: switch (error) {
! 166:
! 167: case 0:
! 168: continue;
! 169:
! 170: case FPE:
! 171: trapsignal(p, SIGFPE,
! 172: fpu_codes[(fs->fs_fsr & FSR_CX) - 1],
! 173: fpu_types[(fs->fs_fsr & FSR_CX) - 1], sv);
! 174: break;
! 175:
! 176: case NOTFPU:
! 177: trapsignal(p, SIGILL, 0, ILL_COPROC, sv);
! 178: break;
! 179:
! 180: default:
! 181: panic("fpu_cleanup 3");
! 182: /* NOTREACHED */
! 183: }
! 184: /* XXX should stop here, but queue remains */
! 185: }
! 186: out:
! 187: fs->fs_qsize = 0;
! 188: }
! 189:
! 190: #ifdef notyet
! 191: /*
! 192: * If we have no FPU at all (are there any machines like this out
! 193: * there!?) we have to emulate each instruction, and we need a pointer
! 194: * to the trapframe so that we can step over them and do FBfcc's.
! 195: * We know the `queue' is empty, though; we just want to emulate
! 196: * the instruction at tf->tf_pc.
! 197: */
! 198: fpu_emulate(p, tf, fs)
! 199: struct proc *p;
! 200: register struct trapframe *tf;
! 201: register struct fpstate *fs;
! 202: {
! 203:
! 204: do {
! 205: fetch instr from pc
! 206: decode
! 207: if (integer instr) {
! 208: /*
! 209: * We do this here, rather than earlier, to avoid
! 210: * losing even more badly than usual.
! 211: */
! 212: if (p->p_addr->u_pcb.pcb_uw) {
! 213: write_user_windows();
! 214: if (rwindow_save(p))
! 215: sigexit(p, SIGILL);
! 216: }
! 217: if (loadstore) {
! 218: do_it;
! 219: pc = npc, npc += 4
! 220: } else if (fbfcc) {
! 221: do_annul_stuff;
! 222: } else
! 223: return;
! 224: } else if (fpu instr) {
! 225: fe.fe_fsr = fs->fs_fsr &= ~FSR_CX;
! 226: error = fpu_execute(&fe, fs, instr);
! 227: switch (error) {
! 228: etc;
! 229: }
! 230: } else
! 231: return;
! 232: if (want to reschedule)
! 233: return;
! 234: } while (error == 0);
! 235: }
! 236: #endif
! 237:
! 238: /*
! 239: * Execute an FPU instruction (one that runs entirely in the FPU; not
! 240: * FBfcc or STF, for instance). On return, fe->fe_fs->fs_fsr will be
! 241: * modified to reflect the setting the hardware would have left.
! 242: *
! 243: * Note that we do not catch all illegal opcodes, so you can, for instance,
! 244: * multiply two integers this way.
! 245: */
! 246: int
! 247: fpu_execute(fe, instr)
! 248: register struct fpemu *fe;
! 249: union instr instr;
! 250: {
! 251: register struct fpn *fp;
! 252: register int opf, rs1, rs2, rd, type, mask, fsr, cx;
! 253: register struct fpstate *fs;
! 254: u_int space[4];
! 255:
! 256: /*
! 257: * `Decode' and execute instruction. Start with no exceptions.
! 258: * The type of any i_opf opcode is in the bottom two bits, so we
! 259: * squish them out here.
! 260: */
! 261: opf = instr.i_opf.i_opf;
! 262: type = opf & 3;
! 263: mask = "\0\0\1\3"[type];
! 264: rs1 = instr.i_opf.i_rs1 & ~mask;
! 265: rs2 = instr.i_opf.i_rs2 & ~mask;
! 266: rd = instr.i_opf.i_rd & ~mask;
! 267: #ifdef notdef
! 268: if ((rs1 | rs2 | rd) & mask)
! 269: return (BADREG);
! 270: #endif
! 271: fs = fe->fe_fpstate;
! 272: fe->fe_fsr = fs->fs_fsr & ~FSR_CX;
! 273: fe->fe_cx = 0;
! 274: switch (opf >>= 2) {
! 275:
! 276: default:
! 277: return (NOTFPU);
! 278:
! 279: case FMOV >> 2: /* these should all be pretty obvious */
! 280: rs1 = fs->fs_regs[rs2];
! 281: goto mov;
! 282:
! 283: case FNEG >> 2:
! 284: rs1 = fs->fs_regs[rs2] ^ (1 << 31);
! 285: goto mov;
! 286:
! 287: case FABS >> 2:
! 288: rs1 = fs->fs_regs[rs2] & ~(1 << 31);
! 289: mov:
! 290: fs->fs_regs[rd] = rs1;
! 291: fs->fs_fsr = fe->fe_fsr;
! 292: return (0); /* success */
! 293:
! 294: case FSQRT >> 2:
! 295: fpu_explode(fe, &fe->fe_f1, type, rs2);
! 296: fp = fpu_sqrt(fe);
! 297: break;
! 298:
! 299: case FADD >> 2:
! 300: fpu_explode(fe, &fe->fe_f1, type, rs1);
! 301: fpu_explode(fe, &fe->fe_f2, type, rs2);
! 302: fp = fpu_add(fe);
! 303: break;
! 304:
! 305: case FSUB >> 2:
! 306: fpu_explode(fe, &fe->fe_f1, type, rs1);
! 307: fpu_explode(fe, &fe->fe_f2, type, rs2);
! 308: fp = fpu_sub(fe);
! 309: break;
! 310:
! 311: case FMUL >> 2:
! 312: fpu_explode(fe, &fe->fe_f1, type, rs1);
! 313: fpu_explode(fe, &fe->fe_f2, type, rs2);
! 314: fp = fpu_mul(fe);
! 315: break;
! 316:
! 317: case FDIV >> 2:
! 318: fpu_explode(fe, &fe->fe_f1, type, rs1);
! 319: fpu_explode(fe, &fe->fe_f2, type, rs2);
! 320: fp = fpu_div(fe);
! 321: break;
! 322:
! 323: case FCMP >> 2:
! 324: fpu_explode(fe, &fe->fe_f1, type, rs1);
! 325: fpu_explode(fe, &fe->fe_f2, type, rs2);
! 326: fpu_compare(fe, 0);
! 327: goto cmpdone;
! 328:
! 329: case FCMPE >> 2:
! 330: fpu_explode(fe, &fe->fe_f1, type, rs1);
! 331: fpu_explode(fe, &fe->fe_f2, type, rs2);
! 332: fpu_compare(fe, 1);
! 333: cmpdone:
! 334: /*
! 335: * The only possible exception here is NV; catch it
! 336: * early and get out, as there is no result register.
! 337: */
! 338: cx = fe->fe_cx;
! 339: fsr = fe->fe_fsr | (cx << FSR_CX_SHIFT);
! 340: if (cx != 0) {
! 341: if (fsr & (FSR_NV << FSR_TEM_SHIFT)) {
! 342: fs->fs_fsr = (fsr & ~FSR_FTT) |
! 343: (FSR_TT_IEEE << FSR_FTT_SHIFT);
! 344: return (FPE);
! 345: }
! 346: fsr |= FSR_NV << FSR_AX_SHIFT;
! 347: }
! 348: fs->fs_fsr = fsr;
! 349: return (0);
! 350:
! 351: case FSMULD >> 2:
! 352: case FDMULX >> 2:
! 353: if (type == FTYPE_EXT)
! 354: return (NOTFPU);
! 355: fpu_explode(fe, &fe->fe_f1, type, rs1);
! 356: fpu_explode(fe, &fe->fe_f2, type, rs2);
! 357: type++; /* single to double, or double to quad */
! 358: fp = fpu_mul(fe);
! 359: break;
! 360:
! 361: case FTOI >> 2:
! 362: case FTOS >> 2:
! 363: rd = instr.i_opf.i_rd;
! 364: goto fto;
! 365: case FTOD >> 2:
! 366: rd = instr.i_opf.i_rd & (~1);
! 367: goto fto;
! 368: case FTOX >> 2:
! 369: rd = instr.i_opf.i_rd & (~3);
! 370:
! 371: fto:
! 372: fpu_explode(fe, fp = &fe->fe_f1, type, rs2);
! 373: type = opf & 3; /* sneaky; depends on instruction encoding */
! 374: break;
! 375: }
! 376:
! 377: /*
! 378: * ALU operation is complete. Collapse the result and then check
! 379: * for exceptions. If we got any, and they are enabled, do not
! 380: * alter the destination register, just stop with an exception.
! 381: * Otherwise set new current exceptions and accrue.
! 382: */
! 383: fpu_implode(fe, fp, type, space);
! 384: cx = fe->fe_cx;
! 385: fsr = fe->fe_fsr;
! 386: if (cx != 0) {
! 387: mask = (fsr >> FSR_TEM_SHIFT) & FSR_TEM_MASK;
! 388: if (cx & mask) {
! 389: /* not accrued??? */
! 390: fs->fs_fsr = (fsr & ~FSR_FTT) |
! 391: (FSR_TT_IEEE << FSR_FTT_SHIFT) |
! 392: (cx_to_trapx[(cx & mask) - 1] << FSR_CX_SHIFT);
! 393: return (FPE);
! 394: }
! 395: fsr |= (cx << FSR_CX_SHIFT) | (cx << FSR_AX_SHIFT);
! 396: }
! 397: fs->fs_fsr = fsr;
! 398: fs->fs_regs[rd] = space[0];
! 399: if (type >= FTYPE_DBL) {
! 400: fs->fs_regs[rd + 1] = space[1];
! 401: if (type > FTYPE_DBL) {
! 402: fs->fs_regs[rd + 2] = space[2];
! 403: fs->fs_regs[rd + 3] = space[3];
! 404: }
! 405: }
! 406: return (0); /* success */
! 407: }
CVSweb