xref: /openbmc/linux/arch/arm/nwfpe/fpa11.inl (revision 1da177e4c3f41524e886b7f1b8a0c1fc7321cac2)
1*1da177e4SLinus Torvalds/*
2*1da177e4SLinus Torvalds    NetWinder Floating Point Emulator
3*1da177e4SLinus Torvalds    (c) Rebel.COM, 1998,1999
4*1da177e4SLinus Torvalds
5*1da177e4SLinus Torvalds    Direct questions, comments to Scott Bambrough <scottb@netwinder.org>
6*1da177e4SLinus Torvalds
7*1da177e4SLinus Torvalds    This program is free software; you can redistribute it and/or modify
8*1da177e4SLinus Torvalds    it under the terms of the GNU General Public License as published by
9*1da177e4SLinus Torvalds    the Free Software Foundation; either version 2 of the License, or
10*1da177e4SLinus Torvalds    (at your option) any later version.
11*1da177e4SLinus Torvalds
12*1da177e4SLinus Torvalds    This program is distributed in the hope that it will be useful,
13*1da177e4SLinus Torvalds    but WITHOUT ANY WARRANTY; without even the implied warranty of
14*1da177e4SLinus Torvalds    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
15*1da177e4SLinus Torvalds    GNU General Public License for more details.
16*1da177e4SLinus Torvalds
17*1da177e4SLinus Torvalds    You should have received a copy of the GNU General Public License
18*1da177e4SLinus Torvalds    along with this program; if not, write to the Free Software
19*1da177e4SLinus Torvalds    Foundation, Inc., 675 Mass Ave, Cambridge, MA 02139, USA.
20*1da177e4SLinus Torvalds*/
21*1da177e4SLinus Torvalds
22*1da177e4SLinus Torvalds#include "fpa11.h"
23*1da177e4SLinus Torvalds
24*1da177e4SLinus Torvalds/* Read and write floating point status register */
25*1da177e4SLinus Torvaldsextern __inline__ unsigned int readFPSR(void)
26*1da177e4SLinus Torvalds{
27*1da177e4SLinus Torvalds	FPA11 *fpa11 = GET_FPA11();
28*1da177e4SLinus Torvalds	return (fpa11->fpsr);
29*1da177e4SLinus Torvalds}
30*1da177e4SLinus Torvalds
31*1da177e4SLinus Torvaldsextern __inline__ void writeFPSR(FPSR reg)
32*1da177e4SLinus Torvalds{
33*1da177e4SLinus Torvalds	FPA11 *fpa11 = GET_FPA11();
34*1da177e4SLinus Torvalds	/* the sysid byte in the status register is readonly */
35*1da177e4SLinus Torvalds	fpa11->fpsr = (fpa11->fpsr & MASK_SYSID) | (reg & ~MASK_SYSID);
36*1da177e4SLinus Torvalds}
37*1da177e4SLinus Torvalds
38*1da177e4SLinus Torvalds/* Read and write floating point control register */
39*1da177e4SLinus Torvaldsextern __inline__ FPCR readFPCR(void)
40*1da177e4SLinus Torvalds{
41*1da177e4SLinus Torvalds	FPA11 *fpa11 = GET_FPA11();
42*1da177e4SLinus Torvalds	/* clear SB, AB and DA bits before returning FPCR */
43*1da177e4SLinus Torvalds	return (fpa11->fpcr & ~MASK_RFC);
44*1da177e4SLinus Torvalds}
45*1da177e4SLinus Torvalds
46*1da177e4SLinus Torvaldsextern __inline__ void writeFPCR(FPCR reg)
47*1da177e4SLinus Torvalds{
48*1da177e4SLinus Torvalds	FPA11 *fpa11 = GET_FPA11();
49*1da177e4SLinus Torvalds	fpa11->fpcr &= ~MASK_WFC;		/* clear SB, AB and DA bits */
50*1da177e4SLinus Torvalds	fpa11->fpcr |= (reg & MASK_WFC);	/* write SB, AB and DA bits */
51*1da177e4SLinus Torvalds}
52