![[BACK]](/cvsweb/icons/back.gif){kind=icon}
Return to npx.c CVS log ![[TXT]](/cvsweb/icons/text.gif){kind=icon}
![[DIR]](/cvsweb/icons/dir.gif){kind=icon}
Up to [Net/2] / Net2 / arch / i386 / isa|
Return to npx.c CVS log | Up to [Net/2] / Net2 / arch / i386 / isa |
1.1 root 1: /*-
2: * Copyright (c) 1990 William Jolitz.
3: * Copyright (c) 1991 The Regents of the University of California.
4: * All rights reserved.
5: *
6: * Redistribution and use in source and binary forms, with or without
7: * modification, are permitted provided that the following conditions
8: * are met:
9: * 1. Redistributions of source code must retain the above copyright
10: * notice, this list of conditions and the following disclaimer.
11: * 2. Redistributions in binary form must reproduce the above copyright
12: * notice, this list of conditions and the following disclaimer in the
13: * documentation and/or other materials provided with the distribution.
14: * 3. All advertising materials mentioning features or use of this software
15: * must display the following acknowledgement:
16: * This product includes software developed by the University of
17: * California, Berkeley and its contributors.
18: * 4. Neither the name of the University nor the names of its contributors
19: * may be used to endorse or promote products derived from this software
20: * without specific prior written permission.
21: *
22: * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS ``AS IS'' AND
23: * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
24: * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
25: * ARE DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE
26: * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
27: * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
28: * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
29: * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
30: * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
31: * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
32: * SUCH DAMAGE.
33: *
34: * @(#)npx.c 7.2 (Berkeley) 5/12/91
35: */
1.1.1.4 ! root 36: static char rcsid[] = "$Header: /cvsroot/src/sys/arch/i386/isa/npx.c,v 1.2 1993/04/03 02:18:02 cgd Exp $";
1.1 root 37: #include "npx.h"
38: #if NNPX > 0
39:
40: #include "param.h"
41: #include "systm.h"
42: #include "conf.h"
43: #include "file.h"
44: #include "proc.h"
45: #include "machine/cpu.h"
46: #include "machine/pcb.h"
47: #include "machine/trap.h"
48: #include "ioctl.h"
49: #include "machine/specialreg.h"
50: #include "i386/isa/isa_device.h"
51: #include "icu.h"
52: /*
53: * 387 and 287 Numeric Coprocessor Extension (NPX) Driver.
54: */
55:
56: int npxprobe(), npxattach(), npxintr();
57: struct isa_driver npxdriver = {
58: npxprobe, npxattach, "npx",
59: };
60:
61: struct proc *npxproc; /* process who owns device, otherwise zero */
62: struct pcb *npxpcb; /* owners context structure */
1.1.1.3 root 63: int npxexists;
1.1 root 64: extern long npx0mask;
65:
66: /*
67: * Probe routine - look device, otherwise set emulator bit
68: */
69: npxprobe(dvp)
70: struct isa_device *dvp;
71: { static status, control;
72:
73: #ifdef lint
74: npxintr();
75: #endif
76:
77: /* insure EM bit off */
1.1.1.2 root 78: load_cr0(rcr0() & ~CR0_EM); /* stop emulating */
1.1 root 79: asm(" fninit "); /* put device in known state */
80:
81: /* check for a proper status of zero */
1.1.1.2 root 82: status = 0x5a5a;
1.1 root 83: asm (" fnstsw %0 " : "=m" (status) : "m" (status) );
84:
1.1.1.2 root 85: if ((status&0xff) == 0) {
1.1 root 86:
87: /* good, now check for a proper control word */
1.1.1.2 root 88: asm (" fnstcw %0 " : "=m" (status) : "m" (status));
1.1 root 89:
1.1.1.2 root 90: if ((status&0x103f) == 0x3f) {
1.1 root 91: /* then we have a numeric coprocessor */
92: /* XXX should force an exception here to generate an intr */
93: return (1);
94: }
95: }
96:
1.1.1.3 root 97: /* insure EM bit on */
1.1.1.2 root 98: load_cr0(rcr0() | CR0_EM); /* start emulating */
1.1 root 99: return (0);
100: }
101:
102: /*
103: * Attach routine - announce which it is, and wire into system
104: */
105: npxattach(dvp)
106: struct isa_device *dvp;
107: {
108:
1.1.1.3 root 109: npxinit(__INITIAL_NPXCW__);
1.1 root 110: npxexists++;
111: npx0mask = dvp->id_irq;
112: }
113:
114: /*
1.1.1.3 root 115: * Initialize floating point unit.
1.1 root 116: */
117: npxinit(control) {
1.1.1.3 root 118: static short wd;
1.1 root 119:
120: if (npxexists == 0) return;
121:
122:
1.1.1.3 root 123: wd = control;
124: wd = 0x272;
1.1 root 125: load_cr0(rcr0() & ~CR0_EM); /* stop emulating */
1.1.1.2 root 126: asm (" fninit");
127: asm(" fldcw %0" : : "g" (wd));
1.1.1.3 root 128: if (curpcb) {
1.1.1.4 ! root 129: #if __GNUC__ >= 2
! 130: asm(" fnsave 0(%0) " : : "a" (&curpcb->pcb_savefpu) );
! 131: #else
1.1.1.3 root 132: asm(" fnsave %0 " : : "g" (curpcb->pcb_savefpu) );
1.1.1.4 ! root 133: #endif
1.1.1.3 root 134: curpcb->pcb_flags |= FP_NEEDSRESTORE;
135: }
1.1 root 136: load_cr0(rcr0() | CR0_EM); /* start emulating */
1.1.1.3 root 137: outb(0xb1,0); /* reset processor */
1.1 root 138: }
139:
140: /*
141: * Load floating point context and record ownership to suite
142: */
143: npxload() {
144:
145: if (npxproc) panic ("npxload");
146: npxproc = curproc;
147: npxpcb = curpcb;
1.1.1.4 ! root 148: #if __GNUC__ >= 2
! 149: asm(" frstor 0(%0) " : : "a" (&curpcb->pcb_savefpu) );
! 150: #else
1.1 root 151: asm(" frstor %0 " : : "g" (curpcb->pcb_savefpu) );
1.1.1.4 ! root 152: #endif
1.1 root 153: }
154:
155: /*
156: * Unload floating point context and relinquish ownership
157: */
158: npxunload() {
159:
160: if (npxproc == 0) panic ("npxunload");
1.1.1.4 ! root 161: #if __GNUC__ >= 2
! 162: asm(" fsave 0(%0) " : : "a" (&npxpcb->pcb_savefpu) );
! 163: #else
1.1 root 164: asm(" fsave %0 " : : "g" (npxpcb->pcb_savefpu) );
1.1.1.4 ! root 165: #endif
1.1 root 166: npxproc = 0 ;
167: }
168:
169: /*
170: * Record information needed in processing an exception and clear status word
171: */
172: npxintr(frame) struct intrframe frame; {
1.1.1.3 root 173: int code;
174: static status;
1.1 root 175:
176: outb(0xf0,0); /* reset processor */
1.1.1.3 root 177: /*pg("npxintr");*/
1.1 root 178:
1.1.1.3 root 179: asm (" fnstsw %0 " : "=m" (status) : "m" (status) );
1.1 root 180: /* sync state in process context structure, in advance of debugger/process looking for it */
181: if (npxproc == 0 || npxexists == 0) panic ("npxintr");
1.1.1.4 ! root 182: #if __GNUC__ >= 2
! 183: asm (" fnsave 0(%0) " : : "a" (&npxpcb->pcb_savefpu) );
! 184: #else
1.1 root 185: asm (" fnsave %0 " : : "g" (npxpcb->pcb_savefpu) );
1.1.1.4 ! root 186: #endif
1.1 root 187:
188: #ifdef notyet
189: /* encode the appropriate code for detailed information on this exception */
1.1.1.3 root 190: code = ???;
191: #else
192: code = 0; /* XXX */
1.1 root 193: #endif
194:
1.1.1.3 root 195: /*if((pg("status %x", status) & 0x7f) == 't') {*/
196: /* pass exception to process, which may not be the current one */
197: if (npxproc == curproc) {
198: /* Q: what if in an interrupt, or in trap processing? */
199: if (ISPL(frame.if_cs) == SEL_UPL) {
200: curproc->p_regs = (int *)&frame.if_es;
201: curpcb->pcb_flags |= FM_TRAP; /* used by sendsig */
202: } /* else printf("*");*/
203: trapsignal(curproc, SIGFPE, code);
204: curpcb->pcb_flags &= ~FM_TRAP; /* used by sendsig */
205: } else {
206: /* printf("P");*/
207: psignal(npxproc, SIGFPE);
208: }
209: /*}*/
1.1 root 210:
211: /* clear the exception so we can catch others like it */
212: asm (" fnclex");
213: }
214:
215: /*
216: * Implement device not available (DNA) exception
217: */
218: npxdna() {
1.1.1.2 root 219: /*pg("npxdna");*/
220:
1.1 root 221:
222: if (npxexists == 0) return(0);
1.1.1.2 root 223: load_cr0(rcr0() & ~CR0_EM); /* stop emulating */
224: if (curpcb->pcb_flags & FP_NEEDSRESTORE)
1.1.1.4 ! root 225: #if __GNUC__ >= 2
! 226: asm(" frstor 0(%0) " : : "a" (&curpcb->pcb_savefpu));
! 227: #else
1.1 root 228: asm(" frstor %0 " : : "g" (curpcb->pcb_savefpu));
1.1.1.4 ! root 229: #endif
1.1.1.2 root 230: curpcb->pcb_flags |= FP_WASUSED | FP_NEEDSSAVE;
231: curpcb->pcb_flags &= ~FP_NEEDSRESTORE;
232: npxproc = curproc;
233: npxpcb = curpcb;
234: return (1);
1.1 root 235: }
236: #endif
This archive runs on limited infrastructure. Preserving old code on modern bandwidth. Automated agents are requested to crawl responsibly.