mirror of
https://github.com/elliotnunn/supermario.git
synced 2024-11-29 20:49:19 +00:00
262 lines
5.9 KiB
Plaintext
262 lines
5.9 KiB
Plaintext
;
|
|
; File: Int.a
|
|
;
|
|
; Contains: Routines to emulate instructions which round or
|
|
; truncate to integer values.
|
|
;
|
|
; Originally Written by: Motorola Inc.
|
|
; Adapted to Apple/MPW: Jon Okada
|
|
;
|
|
; Copyright: © 1990, 1991 by Apple Computer, Inc., all rights reserved.
|
|
;
|
|
; This file is used in these builds: Mac32
|
|
;
|
|
; Change History (most recent first):
|
|
;
|
|
; <2> 3/30/91 BG Rolling in Jon Okada's latest changes.
|
|
; <1> 12/14/90 BG First checked into TERROR/BBS.
|
|
|
|
; Int.a
|
|
|
|
; Based on Motorola file 'sint.sa'.
|
|
|
|
; CHANGE LOG:
|
|
;
|
|
|
|
*
|
|
* sint.sa 3.1 12/10/90
|
|
*
|
|
* The entry point sINT computes the rounded integer
|
|
* equivalent of the input argument, sINTRZ computes
|
|
* the integer rounded to zero of the input argument.
|
|
*
|
|
* Entry points sint and sintrz are called from do_func
|
|
* to emulate the fint and fintrz unimplemented instructions,
|
|
* respectively. Entry point sintdo is used by bindec.
|
|
*
|
|
* Input: (Entry points sint and sintrz) Double-extended
|
|
* number X in the ETEMP space in the floating-point
|
|
* save stack.
|
|
* (Entry point sintdo) Double-extended number X in
|
|
* location pointed to by the address register a0.
|
|
* (Entry point sintd) Double-extended denormalized
|
|
* number X in the ETEMP space in the floating-point
|
|
* save stack.
|
|
*
|
|
* Output: The function returns int(X) or intrz(X) in fp0.
|
|
*
|
|
* Modifies: fp0.
|
|
*
|
|
* Algorithm: (sint and sintrz)
|
|
*
|
|
* 1. If exp(X) >= 63, return X.
|
|
* If exp(X) < 0, return +/- 0 or +/- 1, according to
|
|
* the rounding mode.
|
|
*
|
|
* 2. (X is in range) set rsc = 63 - exp(X). Unnormalize the
|
|
* result to the exponent $403e.
|
|
*
|
|
* 3. Round the result in the mode given in USER_FPCR. For
|
|
* sintrz, force round-to-zero mode.
|
|
*
|
|
* 4. Normalize the rounded result; store in fp0.
|
|
*
|
|
* For the denormalized cases, force the correct result
|
|
* for the given sign and rounding mode.
|
|
*
|
|
* Sign(X)
|
|
* RMODE + -
|
|
* ----- --------
|
|
* RN +0 -0
|
|
* RZ +0 -0
|
|
* RM +0 -1
|
|
* RP +1 -0
|
|
*
|
|
*
|
|
* Copyright (C) Motorola, Inc. 1990
|
|
* All Rights Reserved
|
|
*
|
|
* THIS IS UNPUBLISHED PROPRIETARY SOURCE CODE OF MOTOROLA
|
|
* The copyright notice above does not evidence any
|
|
* actual or intended publication of such source code.
|
|
|
|
* SINT IDNT 2,1 Motorola 040 Floating Point Software Package
|
|
|
|
|
|
*
|
|
* FINT
|
|
*
|
|
|
|
sint:
|
|
bfextu FPCR_MODE(a6){2:2},d1 ;use user's mode for rounding
|
|
* ;implicity has extend precision
|
|
* ;in upper word.
|
|
move.l d1,L_SCR1(a6) ;save mode bits
|
|
bra.b sintexc
|
|
|
|
*
|
|
* FINT with extended denorm inputs.
|
|
*
|
|
|
|
sintd:
|
|
btst.b #5,FPCR_MODE(a6)
|
|
beq snzrinx ;if round nearest or round zero, +/- 0
|
|
btst.b #4,FPCR_MODE(a6)
|
|
beq.b rnd_mns
|
|
rnd_pls:
|
|
btst.b #sign_bit,LOCAL_EX(a0)
|
|
bne.b sintmz
|
|
bsr ld_pone ;if round plus inf and pos, answer is +1
|
|
bra t_inx2
|
|
rnd_mns:
|
|
btst.b #sign_bit,LOCAL_EX(a0)
|
|
beq.b sintpz
|
|
bsr ld_mone ;if round mns inf and neg, answer is -1
|
|
bra t_inx2
|
|
sintpz:
|
|
bsr ld_pzero
|
|
bra t_inx2
|
|
sintmz:
|
|
bsr ld_mzero
|
|
bra t_inx2
|
|
|
|
*
|
|
* FINTRZ
|
|
*
|
|
|
|
sintrz:
|
|
move.l #1,L_SCR1(a6) ;use rz mode for rounding
|
|
* ;implicity has extend precision
|
|
* ;in upper word.
|
|
bra.b sintexc
|
|
|
|
|
|
*
|
|
* SINTDO
|
|
*
|
|
* Input: a0 points to an IEEE extended format operand
|
|
* Output: fp0 has the result
|
|
*
|
|
* Exceptions:
|
|
*
|
|
* If the subroutine results in an inexact operation, the inx2 and
|
|
* ainx bits in the USER_FPSR are set.
|
|
*
|
|
*
|
|
|
|
sintdo:
|
|
bfextu FPCR_MODE(a6){2:2},d1 ;use user's mode for rounding
|
|
* ;implicitly has ext precision
|
|
* ;in upper word.
|
|
move.l d1,L_SCR1(a6) ;save mode bits
|
|
*
|
|
* Real work of sint is in sintexc
|
|
*
|
|
sintexc:
|
|
bclr.b #sign_bit,LOCAL_EX(a0) ;convert to internal extended
|
|
* ;format
|
|
sne LOCAL_SGN(a0)
|
|
cmp.w #$403e,LOCAL_EX(a0) ;check if (unbiased) exp > 63
|
|
bgt.b out_rnge ;branch if exp < 63
|
|
cmp.w #$3ffd,LOCAL_EX(a0) ;check if (unbiased) exp < 0
|
|
bgt.b in_rnge ;if 63 >= exp > 0, do calc
|
|
*
|
|
* Input is less than zero. Restore sign, and check for directed
|
|
* rounding modes. L_SCR1 contains the rmode in the lower byte.
|
|
*
|
|
un_rnge:
|
|
btst.b #1,L_SCR1+3(a6) ;check for rn and rz
|
|
beq.b un_rnrz
|
|
tst.b LOCAL_SGN(a0) ;check for sign
|
|
bne.b un_rmrp_neg
|
|
*
|
|
* Sign is +. If rp, load +1.0, if rm, load +0.0
|
|
*
|
|
cmpi.b #3,L_SCR1+3(a6) ;check for rp
|
|
beq.b un_ldpone ;if rp, load +1.0
|
|
bsr ld_pzero ;if rm, load +0.0
|
|
bra t_inx2
|
|
un_ldpone:
|
|
bsr ld_pone
|
|
bra t_inx2
|
|
*
|
|
* Sign is -. If rm, load -1.0, if rp, load -0.0
|
|
*
|
|
un_rmrp_neg:
|
|
cmpi.b #2,L_SCR1+3(a6) ;check for rm
|
|
beq.b un_ldmone ;if rm, load -1.0
|
|
bsr ld_mzero ;if rp, load -0.0
|
|
bra t_inx2
|
|
un_ldmone:
|
|
bsr ld_mone
|
|
bra t_inx2
|
|
*
|
|
* Rmode is rn or rz; return signed zero
|
|
*
|
|
un_rnrz:
|
|
tst.b LOCAL_SGN(a0) ;check for sign
|
|
bne.b un_rnrz_neg
|
|
bsr ld_pzero
|
|
bra t_inx2
|
|
un_rnrz_neg:
|
|
bsr ld_mzero
|
|
bra t_inx2
|
|
|
|
*
|
|
* Input is greater than 2^63. All bits are significant. Return
|
|
* the input.
|
|
*
|
|
out_rnge:
|
|
bfclr LOCAL_SGN(a0){0:8} ;change back to IEEE ext format
|
|
beq.b intps
|
|
bset.b #sign_bit,LOCAL_EX(a0)
|
|
intps:
|
|
fmove.l fpcr,-(sp)
|
|
fmove.l #0,fpcr
|
|
fmove.x LOCAL_EX(a0),fp0 ;if exp > 63
|
|
* ;then return X to the user
|
|
* ;there are no fraction bits
|
|
fmove.l (sp)+,fpcr
|
|
rts
|
|
|
|
in_rnge:
|
|
* ;shift off fraction bits
|
|
clr.l d0 ;clear d0 - initial g,r,s for
|
|
* ;dnrm_lp
|
|
move.l #$403e,d1 ;set threshold for dnrm_lp
|
|
* ;assumes a0 points to operand
|
|
bsr dnrm_lp
|
|
* ;returns unnormalized number
|
|
* ;pointed by a0
|
|
* ;output d0 supplies g,r,s
|
|
* ;used by round
|
|
move.l L_SCR1(a6),d1 ;use selected rounding mode
|
|
*
|
|
*
|
|
bsr round ;round the unnorm based on users
|
|
* ;input a0 ptr to ext X
|
|
* ; d0 g,r,s bits
|
|
* ; d1 PREC/MODE info
|
|
* ;output a0 ptr to rounded result
|
|
* ;inexact flag set in USER_FPSR
|
|
* ;if initial grs set
|
|
*
|
|
* normalize the rounded result and store value in fp0
|
|
*
|
|
bsr nrm_set ;normalize the unnorm
|
|
* ;Input: a0 points to operand to
|
|
* ;be normalized
|
|
* ;Output: a0 points to normalized
|
|
* ;result
|
|
bfclr LOCAL_SGN(a0){0:8}
|
|
beq.b nrmrndp
|
|
bset.b #sign_bit,LOCAL_EX(a0) ;return to IEEE extended format
|
|
nrmrndp:
|
|
fmove.l fpcr,-(sp)
|
|
fmove.l #0,fpcr
|
|
fmove.x LOCAL_EX(a0),fp0 ;move result to fp0
|
|
fmove.l (sp)+,fpcr
|
|
rts
|
|
|
|
|