NetBSD/sys/arch/m68k/fpsp/sto_res.sa

122 lines
3.1 KiB
Plaintext

* MOTOROLA MICROPROCESSOR & MEMORY TECHNOLOGY GROUP
* M68000 Hi-Performance Microprocessor Division
* M68040 Software Package
*
* M68040 Software Package Copyright (c) 1993, 1994 Motorola Inc.
* All rights reserved.
*
* THE SOFTWARE is provided on an "AS IS" basis and without warranty.
* To the maximum extent permitted by applicable law,
* MOTOROLA DISCLAIMS ALL WARRANTIES WHETHER EXPRESS OR IMPLIED,
* INCLUDING IMPLIED WARRANTIES OF MERCHANTABILITY OR FITNESS FOR A
* PARTICULAR PURPOSE and any warranty against infringement with
* regard to the SOFTWARE (INCLUDING ANY MODIFIED VERSIONS THEREOF)
* and any accompanying written materials.
*
* To the maximum extent permitted by applicable law,
* IN NO EVENT SHALL MOTOROLA BE LIABLE FOR ANY DAMAGES WHATSOEVER
* (INCLUDING WITHOUT LIMITATION, DAMAGES FOR LOSS OF BUSINESS
* PROFITS, BUSINESS INTERRUPTION, LOSS OF BUSINESS INFORMATION, OR
* OTHER PECUNIARY LOSS) ARISING OF THE USE OR INABILITY TO USE THE
* SOFTWARE. Motorola assumes no responsibility for the maintenance
* and support of the SOFTWARE.
*
* You are hereby granted a copyright license to use, modify, and
* distribute the SOFTWARE so long as this entire notice is retained
* without alteration in any modified and/or redistributed versions,
* and that such modified versions are clearly identified as such.
* No licenses are granted by implication, estoppel or otherwise
* under any patents or trademarks of Motorola, Inc.
*
* sto_res.sa 3.1 12/10/90
*
* Takes the result and puts it in where the user expects it.
* Library functions return result in fp0. If fp0 is not the
* users destination register then fp0 is moved to the the
* correct floating-point destination register. fp0 and fp1
* are then restored to the original contents.
*
* Input: result in fp0,fp1
*
* d2 & a0 should be kept unmodified
*
* Output: moves the result to the true destination reg or mem
*
* Modifies: destination floating point register
*
STO_RES IDNT 2,1 Motorola 040 Floating Point Software Package
section 8
include fpsp.h
xdef sto_cos
sto_cos:
bfextu CMDREG1B(a6){13:3},d0 ;extract cos destination
cmpi.b #3,d0 ;check for fp0/fp1 cases
ble.b c_fp0123
fmovem.x fp1,-(a7)
moveq.l #7,d1
sub.l d0,d1 ;d1 = 7- (dest. reg. no.)
clr.l d0
bset.l d1,d0 ;d0 is dynamic register mask
fmovem.x (a7)+,d0
rts
c_fp0123:
tst.b d0
beq.b c_is_fp0
cmpi.b #1,d0
beq.b c_is_fp1
cmpi.b #2,d0
beq.b c_is_fp2
c_is_fp3:
fmovem.x fp1,USER_FP3(a6)
rts
c_is_fp2:
fmovem.x fp1,USER_FP2(a6)
rts
c_is_fp1:
fmovem.x fp1,USER_FP1(a6)
rts
c_is_fp0:
fmovem.x fp1,USER_FP0(a6)
rts
xdef sto_res
sto_res:
bfextu CMDREG1B(a6){6:3},d0 ;extract destination register
cmpi.b #3,d0 ;check for fp0/fp1 cases
ble.b fp0123
fmovem.x fp0,-(a7)
moveq.l #7,d1
sub.l d0,d1 ;d1 = 7- (dest. reg. no.)
clr.l d0
bset.l d1,d0 ;d0 is dynamic register mask
fmovem.x (a7)+,d0
rts
fp0123:
tst.b d0
beq.b is_fp0
cmpi.b #1,d0
beq.b is_fp1
cmpi.b #2,d0
beq.b is_fp2
is_fp3:
fmovem.x fp0,USER_FP3(a6)
rts
is_fp2:
fmovem.x fp0,USER_FP2(a6)
rts
is_fp1:
fmovem.x fp0,USER_FP1(a6)
rts
is_fp0:
fmovem.x fp0,USER_FP0(a6)
rts
end