NetBSD/sys/arch/i386/isa/npx.c

237 lines
6.4 KiB
C

/*-
* Copyright (c) 1990 William Jolitz.
* Copyright (c) 1991 The Regents of the University of California.
* All rights reserved.
*
* Redistribution and use in source and binary forms, with or without
* modification, are permitted provided that the following conditions
* are met:
* 1. Redistributions of source code must retain the above copyright
* notice, this list of conditions and the following disclaimer.
* 2. Redistributions in binary form must reproduce the above copyright
* notice, this list of conditions and the following disclaimer in the
* documentation and/or other materials provided with the distribution.
* 3. All advertising materials mentioning features or use of this software
* must display the following acknowledgement:
* This product includes software developed by the University of
* California, Berkeley and its contributors.
* 4. Neither the name of the University nor the names of its contributors
* may be used to endorse or promote products derived from this software
* without specific prior written permission.
*
* THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
* ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
* IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
* ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
* FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
* DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
* OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
* HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
* LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
* OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
* SUCH DAMAGE.
*
* @(#)npx.c 7.2 (Berkeley) 5/12/91
*/
static char rcsid[] = "$Header: /cvsroot/src/sys/arch/i386/isa/Attic/npx.c,v 1.2 1993/04/03 02:18:02 cgd Exp $";
#include "npx.h"
#if NNPX > 0
#include "param.h"
#include "systm.h"
#include "conf.h"
#include "file.h"
#include "proc.h"
#include "machine/cpu.h"
#include "machine/pcb.h"
#include "machine/trap.h"
#include "ioctl.h"
#include "machine/specialreg.h"
#include "i386/isa/isa_device.h"
#include "icu.h"
/*
* 387 and 287 Numeric Coprocessor Extension (NPX) Driver.
*/
int npxprobe(), npxattach(), npxintr();
struct isa_driver npxdriver = {
npxprobe, npxattach, "npx",
};
struct proc *npxproc; /* process who owns device, otherwise zero */
struct pcb *npxpcb; /* owners context structure */
int npxexists;
extern long npx0mask;
/*
* Probe routine - look device, otherwise set emulator bit
*/
npxprobe(dvp)
struct isa_device *dvp;
{ static status, control;
#ifdef lint
npxintr();
#endif
/* insure EM bit off */
load_cr0(rcr0() & ~CR0_EM); /* stop emulating */
asm(" fninit "); /* put device in known state */
/* check for a proper status of zero */
status = 0x5a5a;
asm (" fnstsw %0 " : "=m" (status) : "m" (status) );
if ((status&0xff) == 0) {
/* good, now check for a proper control word */
asm (" fnstcw %0 " : "=m" (status) : "m" (status));
if ((status&0x103f) == 0x3f) {
/* then we have a numeric coprocessor */
/* XXX should force an exception here to generate an intr */
return (1);
}
}
/* insure EM bit on */
load_cr0(rcr0() | CR0_EM); /* start emulating */
return (0);
}
/*
* Attach routine - announce which it is, and wire into system
*/
npxattach(dvp)
struct isa_device *dvp;
{
npxinit(__INITIAL_NPXCW__);
npxexists++;
npx0mask = dvp->id_irq;
}
/*
* Initialize floating point unit.
*/
npxinit(control) {
static short wd;
if (npxexists == 0) return;
wd = control;
wd = 0x272;
load_cr0(rcr0() & ~CR0_EM); /* stop emulating */
asm (" fninit");
asm(" fldcw %0" : : "g" (wd));
if (curpcb) {
#if __GNUC__ >= 2
asm(" fnsave 0(%0) " : : "a" (&curpcb->pcb_savefpu) );
#else
asm(" fnsave %0 " : : "g" (curpcb->pcb_savefpu) );
#endif
curpcb->pcb_flags |= FP_NEEDSRESTORE;
}
load_cr0(rcr0() | CR0_EM); /* start emulating */
outb(0xb1,0); /* reset processor */
}
/*
* Load floating point context and record ownership to suite
*/
npxload() {
if (npxproc) panic ("npxload");
npxproc = curproc;
npxpcb = curpcb;
#if __GNUC__ >= 2
asm(" frstor 0(%0) " : : "a" (&curpcb->pcb_savefpu) );
#else
asm(" frstor %0 " : : "g" (curpcb->pcb_savefpu) );
#endif
}
/*
* Unload floating point context and relinquish ownership
*/
npxunload() {
if (npxproc == 0) panic ("npxunload");
#if __GNUC__ >= 2
asm(" fsave 0(%0) " : : "a" (&npxpcb->pcb_savefpu) );
#else
asm(" fsave %0 " : : "g" (npxpcb->pcb_savefpu) );
#endif
npxproc = 0 ;
}
/*
* Record information needed in processing an exception and clear status word
*/
npxintr(frame) struct intrframe frame; {
int code;
static status;
outb(0xf0,0); /* reset processor */
/*pg("npxintr");*/
asm (" fnstsw %0 " : "=m" (status) : "m" (status) );
/* sync state in process context structure, in advance of debugger/process looking for it */
if (npxproc == 0 || npxexists == 0) panic ("npxintr");
#if __GNUC__ >= 2
asm (" fnsave 0(%0) " : : "a" (&npxpcb->pcb_savefpu) );
#else
asm (" fnsave %0 " : : "g" (npxpcb->pcb_savefpu) );
#endif
#ifdef notyet
/* encode the appropriate code for detailed information on this exception */
code = ???;
#else
code = 0; /* XXX */
#endif
/*if((pg("status %x", status) & 0x7f) == 't') {*/
/* pass exception to process, which may not be the current one */
if (npxproc == curproc) {
/* Q: what if in an interrupt, or in trap processing? */
if (ISPL(frame.if_cs) == SEL_UPL) {
curproc->p_regs = (int *)&frame.if_es;
curpcb->pcb_flags |= FM_TRAP; /* used by sendsig */
} /* else printf("*");*/
trapsignal(curproc, SIGFPE, code);
curpcb->pcb_flags &= ~FM_TRAP; /* used by sendsig */
} else {
/* printf("P");*/
psignal(npxproc, SIGFPE);
}
/*}*/
/* clear the exception so we can catch others like it */
asm (" fnclex");
}
/*
* Implement device not available (DNA) exception
*/
npxdna() {
/*pg("npxdna");*/
if (npxexists == 0) return(0);
load_cr0(rcr0() & ~CR0_EM); /* stop emulating */
if (curpcb->pcb_flags & FP_NEEDSRESTORE)
#if __GNUC__ >= 2
asm(" frstor 0(%0) " : : "a" (&curpcb->pcb_savefpu));
#else
asm(" frstor %0 " : : "g" (curpcb->pcb_savefpu));
#endif
curpcb->pcb_flags |= FP_WASUSED | FP_NEEDSSAVE;
curpcb->pcb_flags &= ~FP_NEEDSRESTORE;
npxproc = curproc;
npxpcb = curpcb;
return (1);
}
#endif