121 lines
3.6 KiB
C
121 lines
3.6 KiB
C
/* $NetBSD: fpu.c,v 1.8 1997/10/09 08:31:58 jtc Exp $ */
|
|
|
|
/*-
|
|
* Copyright (c) 1996 The NetBSD Foundation, Inc.
|
|
* All rights reserved.
|
|
*
|
|
* This code is derived from software contributed to The NetBSD Foundation
|
|
* by Gordon W. Ross.
|
|
*
|
|
* 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 NetBSD
|
|
* Foundation, Inc. and its contributors.
|
|
* 4. Neither the name of The NetBSD Foundation 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 NETBSD FOUNDATION, INC. 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 FOUNDATION 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.
|
|
*/
|
|
|
|
/*
|
|
* Floating Point Unit (MC68881/882/040/060)
|
|
* Probe for the FPU at autoconfig time.
|
|
*/
|
|
|
|
#include <sys/param.h>
|
|
#include <sys/systm.h>
|
|
#include <sys/time.h>
|
|
#include <sys/kernel.h>
|
|
#include <sys/device.h>
|
|
|
|
#include <machine/psl.h>
|
|
#include <machine/cpu.h>
|
|
#include <machine/frame.h>
|
|
|
|
extern int *nofault;
|
|
|
|
int
|
|
fpu_probe()
|
|
{
|
|
/*
|
|
* A 68881 idle frame is 28 bytes and a 68882's is 60 bytes.
|
|
* We, of course, need to have enough room for either.
|
|
*/
|
|
struct fpframe fpframe;
|
|
label_t faultbuf;
|
|
u_char b;
|
|
|
|
nofault = (int *) &faultbuf;
|
|
if (setjmp(&faultbuf)) {
|
|
nofault = (int *) 0;
|
|
return FPU_NONE;
|
|
}
|
|
|
|
/*
|
|
* Synchronize FPU or cause a fault.
|
|
* This should leave the 881/882 in the IDLE state,
|
|
* state, so we can determine which we have by
|
|
* examining the size of the FP state frame
|
|
*/
|
|
asm("fnop");
|
|
|
|
nofault = (int *) 0;
|
|
|
|
/*
|
|
* Presumably, if we're an 040/060 and did not take exception
|
|
* above, we have an FPU. Don't bother probing.
|
|
*/
|
|
if (cputype == CPU_68060) {
|
|
return FPU_68060;
|
|
} else if (cputype == CPU_68040) {
|
|
return FPU_68040;
|
|
}
|
|
|
|
/*
|
|
* Presumably, this will not cause a fault--the fnop should
|
|
* have if this will. We save the state in order to get the
|
|
* size of the frame.
|
|
*/
|
|
asm("movl %0, a0; fsave a0@" : : "a" (&fpframe) : "a0" );
|
|
|
|
b = fpframe.fpf_fsize;
|
|
|
|
/*
|
|
* Now, restore a NULL state to reset the FPU.
|
|
*/
|
|
fpframe.fpf_null = 0;
|
|
fpframe.fpf_idle.fpf_ccr = 0;
|
|
m68881_restore(&fpframe);
|
|
|
|
/*
|
|
* The size of a 68881 IDLE frame is 0x18
|
|
* and a 68882 frame is 0x38
|
|
*/
|
|
if (b == 0x18) return FPU_68881;
|
|
if (b == 0x38) return FPU_68882;
|
|
|
|
/*
|
|
* If it's not one of the above, we have no clue what it is.
|
|
*/
|
|
return FPU_UNKNOWN;
|
|
}
|