124 lines
3.2 KiB
Plaintext
124 lines
3.2 KiB
Plaintext
* $NetBSD: sto_res.sa,v 1.3 1994/10/26 07:50:14 cgd Exp $
|
|
|
|
* 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
|