|
|       scale.sa 3.3 7/30/91
|
|       The entry point sSCALE computes the destination operand
|       scaled by the source operand.  If the absolute value of
|       the source operand is (>= 2^14) an overflow or underflow
|       is returned.
|
|       The entry point sscale is called from do_func to emulate
|       the fscale unimplemented instruction.
|
|       Input: Double-extended destination operand in FPTEMP,
|               double-extended source operand in ETEMP.
|
|       Output: The function returns scale(X,Y) to fp0.
|
|       Modifies: fp0.
|
|       Algorithm:
|
|               Copyright (C) Motorola, Inc. 1990
|                       All Rights Reserved
|
|       For details on the license for this file, please see the
|       file, README, in this same directory.

|SCALE    idnt    2,1 | Motorola 040 Floating Point Software Package

        |section        8

#include "fpsp.h"

        |xref   t_ovfl2
        |xref   t_unfl
        |xref   round
        |xref   t_resdnrm

SRC_BNDS: .short        0x3fff,0x400c

|
| This entry point is used by the unimplemented instruction exception
| handler.
|
|
|
|       FSCALE
|
        .global sscale
sscale:
        fmovel          #0,%fpcr                |clr user enabled exc
        clrl            %d1
        movew           FPTEMP(%a6),%d1 |get dest exponent
        smi             L_SCR1(%a6)     |use L_SCR1 to hold sign
        andil           #0x7fff,%d1     |strip sign
        movew           ETEMP(%a6),%d0  |check src bounds
        andiw           #0x7fff,%d0     |clr sign bit
        cmp2w           SRC_BNDS,%d0
        bccs            src_in
        cmpiw           #0x400c,%d0     |test for too large
        bge             src_out
|
| The source input is below 1, so we check for denormalized numbers
| and set unfl.
|
src_small:
        moveb           DTAG(%a6),%d0
        andib           #0xe0,%d0
        tstb            %d0
        beqs            no_denorm
        st              STORE_FLG(%a6)  |dest already contains result
        orl             #unfl_mask,USER_FPSR(%a6) |set UNFL
den_done:
        leal            FPTEMP(%a6),%a0
        bra             t_resdnrm
no_denorm:
        fmovel          USER_FPCR(%a6),%FPCR
        fmovex          FPTEMP(%a6),%fp0        |simply return dest
        rts


|
| Source is within 2^14 range.  To perform the int operation,
| move it to d0.
|
src_in:
        fmovex          ETEMP(%a6),%fp0 |move in src for int
        fmovel          #rz_mode,%fpcr  |force rz for src conversion
        fmovel          %fp0,%d0                |int src to d0
        fmovel          #0,%FPSR                |clr status from above
        tstw            ETEMP(%a6)      |check src sign
        blt             src_neg
|
| Source is positive.  Add the src to the dest exponent.
| The result can be denormalized, if src = 0, or overflow,
| if the result of the add sets a bit in the upper word.
|
src_pos:
        tstw            %d1             |check for denorm
        beq             dst_dnrm
        addl            %d0,%d1         |add src to dest exp
        beqs            denorm          |if zero, result is denorm
        cmpil           #0x7fff,%d1     |test for overflow
        bges            ovfl
        tstb            L_SCR1(%a6)
        beqs            spos_pos
        orw             #0x8000,%d1
spos_pos:
        movew           %d1,FPTEMP(%a6) |result in FPTEMP
        fmovel          USER_FPCR(%a6),%FPCR
        fmovex          FPTEMP(%a6),%fp0        |write result to fp0
        rts
ovfl:
        tstb            L_SCR1(%a6)
        beqs            sovl_pos
        orw             #0x8000,%d1
sovl_pos:
        movew           FPTEMP(%a6),ETEMP(%a6)  |result in ETEMP
        movel           FPTEMP_HI(%a6),ETEMP_HI(%a6)
        movel           FPTEMP_LO(%a6),ETEMP_LO(%a6)
        bra             t_ovfl2

denorm:
        tstb            L_SCR1(%a6)
        beqs            den_pos
        orw             #0x8000,%d1
den_pos:
        tstl            FPTEMP_HI(%a6)  |check j bit
        blts            nden_exit       |if set, not denorm
        movew           %d1,ETEMP(%a6)  |input expected in ETEMP
        movel           FPTEMP_HI(%a6),ETEMP_HI(%a6)
        movel           FPTEMP_LO(%a6),ETEMP_LO(%a6)
        orl             #unfl_bit,USER_FPSR(%a6)        |set unfl
        leal            ETEMP(%a6),%a0
        bra             t_resdnrm
nden_exit:
        movew           %d1,FPTEMP(%a6) |result in FPTEMP
        fmovel          USER_FPCR(%a6),%FPCR
        fmovex          FPTEMP(%a6),%fp0        |write result to fp0
        rts

|
| Source is negative.  Add the src to the dest exponent.
| (The result exponent will be reduced).  The result can be
| denormalized.
|
src_neg:
        addl            %d0,%d1         |add src to dest
        beqs            denorm          |if zero, result is denorm
        blts            fix_dnrm        |if negative, result is
|                                       ;needing denormalization
        tstb            L_SCR1(%a6)
        beqs            sneg_pos
        orw             #0x8000,%d1
sneg_pos:
        movew           %d1,FPTEMP(%a6) |result in FPTEMP
        fmovel          USER_FPCR(%a6),%FPCR
        fmovex          FPTEMP(%a6),%fp0        |write result to fp0
        rts


|
| The result exponent is below denorm value.  Test for catastrophic
| underflow and force zero if true.  If not, try to shift the
| mantissa right until a zero exponent exists.
|
fix_dnrm:
        cmpiw           #0xffc0,%d1     |lower bound for normalization
        blt             fix_unfl        |if lower, catastrophic unfl
        movew           %d1,%d0         |use d0 for exp
        movel           %d2,-(%a7)      |free d2 for norm
        movel           FPTEMP_HI(%a6),%d1
        movel           FPTEMP_LO(%a6),%d2
        clrl            L_SCR2(%a6)
fix_loop:
        addw            #1,%d0          |drive d0 to 0
        lsrl            #1,%d1          |while shifting the
        roxrl           #1,%d2          |mantissa to the right
        bccs            no_carry
        st              L_SCR2(%a6)     |use L_SCR2 to capture inex
no_carry:
        tstw            %d0             |it is finished when
        blts            fix_loop        |d0 is zero or the mantissa
        tstb            L_SCR2(%a6)
        beqs            tst_zero
        orl             #unfl_inx_mask,USER_FPSR(%a6)
|                                       ;set unfl, aunfl, ainex
|
| Test for zero. If zero, simply use fmove to return +/- zero
| to the fpu.
|
tst_zero:
        clrw            FPTEMP_EX(%a6)
        tstb            L_SCR1(%a6)     |test for sign
        beqs            tst_con
        orw             #0x8000,FPTEMP_EX(%a6) |set sign bit
tst_con:
        movel           %d1,FPTEMP_HI(%a6)
        movel           %d2,FPTEMP_LO(%a6)
        movel           (%a7)+,%d2
        tstl            %d1
        bnes            not_zero
        tstl            FPTEMP_LO(%a6)
        bnes            not_zero
|
| Result is zero.  Check for rounding mode to set lsb.  If the
| mode is rp, and the zero is positive, return smallest denorm.
| If the mode is rm, and the zero is negative, return smallest
| negative denorm.
|
        btstb           #5,FPCR_MODE(%a6) |test if rm or rp
        beqs            no_dir
        btstb           #4,FPCR_MODE(%a6) |check which one
        beqs            zer_rm
zer_rp:
        tstb            L_SCR1(%a6)     |check sign
        bnes            no_dir          |if set, neg op, no inc
        movel           #1,FPTEMP_LO(%a6) |set lsb
        bras            sm_dnrm
zer_rm:
        tstb            L_SCR1(%a6)     |check sign
        beqs            no_dir          |if clr, neg op, no inc
        movel           #1,FPTEMP_LO(%a6) |set lsb
        orl             #neg_mask,USER_FPSR(%a6) |set N
        bras            sm_dnrm
no_dir:
        fmovel          USER_FPCR(%a6),%FPCR
        fmovex          FPTEMP(%a6),%fp0        |use fmove to set cc's
        rts

|
| The rounding mode changed the zero to a smallest denorm. Call
| t_resdnrm with exceptional operand in ETEMP.
|
sm_dnrm:
        movel           FPTEMP_EX(%a6),ETEMP_EX(%a6)
        movel           FPTEMP_HI(%a6),ETEMP_HI(%a6)
        movel           FPTEMP_LO(%a6),ETEMP_LO(%a6)
        leal            ETEMP(%a6),%a0
        bra             t_resdnrm

|
| Result is still denormalized.
|
not_zero:
        orl             #unfl_mask,USER_FPSR(%a6) |set unfl
        tstb            L_SCR1(%a6)     |check for sign
        beqs            fix_exit
        orl             #neg_mask,USER_FPSR(%a6) |set N
fix_exit:
        bras            sm_dnrm


|
| The result has underflowed to zero. Return zero and set
| unfl, aunfl, and ainex.
|
fix_unfl:
        orl             #unfl_inx_mask,USER_FPSR(%a6)
        btstb           #5,FPCR_MODE(%a6) |test if rm or rp
        beqs            no_dir2
        btstb           #4,FPCR_MODE(%a6) |check which one
        beqs            zer_rm2
zer_rp2:
        tstb            L_SCR1(%a6)     |check sign
        bnes            no_dir2         |if set, neg op, no inc
        clrl            FPTEMP_EX(%a6)
        clrl            FPTEMP_HI(%a6)
        movel           #1,FPTEMP_LO(%a6) |set lsb
        bras            sm_dnrm         |return smallest denorm
zer_rm2:
        tstb            L_SCR1(%a6)     |check sign
        beqs            no_dir2         |if clr, neg op, no inc
        movew           #0x8000,FPTEMP_EX(%a6)
        clrl            FPTEMP_HI(%a6)
        movel           #1,FPTEMP_LO(%a6) |set lsb
        orl             #neg_mask,USER_FPSR(%a6) |set N
        bra             sm_dnrm         |return smallest denorm

no_dir2:
        tstb            L_SCR1(%a6)
        bges            pos_zero
neg_zero:
        clrl            FP_SCR1(%a6)    |clear the exceptional operand
        clrl            FP_SCR1+4(%a6)  |for gen_except.
        clrl            FP_SCR1+8(%a6)
        fmoves          #0x80000000,%fp0
        rts
pos_zero:
        clrl            FP_SCR1(%a6)    |clear the exceptional operand
        clrl            FP_SCR1+4(%a6)  |for gen_except.
        clrl            FP_SCR1+8(%a6)
        fmoves          #0x00000000,%fp0
        rts

|
| The destination is a denormalized number.  It must be handled
| by first shifting the bits in the mantissa until it is normalized,
| then adding the remainder of the source to the exponent.
|
dst_dnrm:
        moveml          %d2/%d3,-(%a7)
        movew           FPTEMP_EX(%a6),%d1
        movel           FPTEMP_HI(%a6),%d2
        movel           FPTEMP_LO(%a6),%d3
dst_loop:
        tstl            %d2             |test for normalized result
        blts            dst_norm        |exit loop if so
        tstl            %d0             |otherwise, test shift count
        beqs            dst_fin         |if zero, shifting is done
        subil           #1,%d0          |dec src
        lsll            #1,%d3
        roxll           #1,%d2
        bras            dst_loop
|
| Destination became normalized.  Simply add the remaining
| portion of the src to the exponent.
|
dst_norm:
        addw            %d0,%d1         |dst is normalized; add src
        tstb            L_SCR1(%a6)
        beqs            dnrm_pos
        orl             #0x8000,%d1
dnrm_pos:
        movemw          %d1,FPTEMP_EX(%a6)
        moveml          %d2,FPTEMP_HI(%a6)
        moveml          %d3,FPTEMP_LO(%a6)
        fmovel          USER_FPCR(%a6),%FPCR
        fmovex          FPTEMP(%a6),%fp0
        moveml          (%a7)+,%d2/%d3
        rts

|
| Destination remained denormalized.  Call t_excdnrm with
| exceptional operand in ETEMP.
|
dst_fin:
        tstb            L_SCR1(%a6)     |check for sign
        beqs            dst_exit
        orl             #neg_mask,USER_FPSR(%a6) |set N
        orl             #0x8000,%d1
dst_exit:
        movemw          %d1,ETEMP_EX(%a6)
        moveml          %d2,ETEMP_HI(%a6)
        moveml          %d3,ETEMP_LO(%a6)
        orl             #unfl_mask,USER_FPSR(%a6) |set unfl
        moveml          (%a7)+,%d2/%d3
        leal            ETEMP(%a6),%a0
        bra             t_resdnrm

|
| Source is outside of 2^14 range.  Test the sign and branch
| to the appropriate exception handler.
|
src_out:
        tstb            L_SCR1(%a6)
        beqs            scro_pos
        orl             #0x8000,%d1
scro_pos:
        movel           FPTEMP_HI(%a6),ETEMP_HI(%a6)
        movel           FPTEMP_LO(%a6),ETEMP_LO(%a6)
        tstw            ETEMP(%a6)
        blts            res_neg
res_pos:
        movew           %d1,ETEMP(%a6)  |result in ETEMP
        bra             t_ovfl2
res_neg:
        movew           %d1,ETEMP(%a6)  |result in ETEMP
        leal            ETEMP(%a6),%a0
        bra             t_unfl
        |end