Subversion Repositories or1k

//

//      $Id: round.S,v 1.2 2001-09-27 12:01:22 chris Exp $

//

//      round.sa 3.4 7/29/91

//

//      handle rounding and normalization tasks

//

//

//

//              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.

//ROUND idnt    2,1 | Motorola 040 Floating Point Software Package

        |section        8

#include "fpsp.defs"

//

//      round --- round result according to precision/mode

//

//      a0 points to the input operand in the internal extended format

//      d1(high word) contains rounding precision:

//              ext = $0000xxxx

//              sgl = $0001xxxx

//              dbl = $0002xxxx

//      d1(low word) contains rounding mode:

//              RN  = $xxxx0000

//              RZ  = $xxxx0001

//              RM  = $xxxx0010

//              RP  = $xxxx0011

//      d0{31:29} contains the g,r,s bits (extended)

//

//      On return the value pointed to by a0 is correctly rounded,

//      a0 is preserved and the g-r-s bits in d0 are cleared.

//      The result is not typed - the tag field is invalid.  The

//      result is still in the internal extended format.

//

//      The INEX bit of USER_FPSR will be set if the rounded result was

//      inexact (i.e. if any of the g-r-s bits were set).

//

        .global round

round:

// If g=r=s=0 then result is exact and round is done, else set

// the inex flag in status reg and continue.

//

        bsrs    ext_grs                 //this subroutine looks at the

//                                      :rounding precision and sets

//                                      ;the appropriate g-r-s bits.

        tstl    %d0                     //if grs are zero, go force

        bne     rnd_cont                //lower bits to zero for size

        swap    %d1                     //set up d1.w for round prec.

        bra     truncate

rnd_cont:

//

// Use rounding mode as an index into a jump table for these modes.

//

        orl     #inx2a_mask,USER_FPSR(%a6) //set inex2/ainex

        lea     mode_tab,%a1

        movel   (%a1,%d1.w*4),%a1

        jmp     (%a1)

//

// Jump table indexed by rounding mode in d1.w.  All following assumes

// grs != 0.

//

mode_tab:

        .long   rnd_near

        .long   rnd_zero

        .long   rnd_mnus

        .long   rnd_plus

//

//      ROUND PLUS INFINITY

//

//      If sign of fp number = 0 (positive), then add 1 to l.

//

rnd_plus:

        swap    %d1                     //set up d1 for round prec.

        tstb    LOCAL_SGN(%a0)          //check for sign

        bmi     truncate                //if positive then truncate

        movel   #0xffffffff,%d0         //force g,r,s to be all f's

        lea     add_to_l,%a1

        movel   (%a1,%d1.w*4),%a1

        jmp     (%a1)

//

//      ROUND MINUS INFINITY

//

//      If sign of fp number = 1 (negative), then add 1 to l.

//

rnd_mnus:

        swap    %d1                     //set up d1 for round prec.

        tstb    LOCAL_SGN(%a0)          //check for sign

        bpl     truncate                //if negative then truncate

        movel   #0xffffffff,%d0         //force g,r,s to be all f's

        lea     add_to_l,%a1

        movel   (%a1,%d1.w*4),%a1

        jmp     (%a1)

//

//      ROUND ZERO

//

//      Always truncate.

rnd_zero:

        swap    %d1                     //set up d1 for round prec.

        bra     truncate

//

//

//      ROUND NEAREST

//

//      If (g=1), then add 1 to l and if (r=s=0), then clear l

//      Note that this will round to even in case of a tie.

//

rnd_near:

        swap    %d1                     //set up d1 for round prec.

        asll    #1,%d0                  //shift g-bit to c-bit

        bcc     truncate                //if (g=1) then

        lea     add_to_l,%a1

        movel   (%a1,%d1.w*4),%a1

        jmp     (%a1)

//

//      ext_grs --- extract guard, round and sticky bits

//

// Input:       d1 =            PREC:ROUND

// Output:      d0{31:29}=      guard, round, sticky

//

// The ext_grs extract the guard/round/sticky bits according to the

// selected rounding precision. It is called by the round subroutine

// only.  All registers except d0 are kept intact. d0 becomes an

// updated guard,round,sticky in d0{31:29}

//

// Notes: the ext_grs uses the round PREC, and therefore has to swap d1

//       prior to usage, and needs to restore d1 to original.

//

ext_grs:

        swap    %d1                     //have d1.w point to round precision

        cmpiw   #0,%d1

        bnes    sgl_or_dbl

        bras    end_ext_grs

sgl_or_dbl:

        moveml  %d2/%d3,-(%a7)          //make some temp registers

        cmpiw   #1,%d1

        bnes    grs_dbl

grs_sgl:

        bfextu  LOCAL_HI(%a0){#24:#2},%d3       //sgl prec. g-r are 2 bits right

        movel   #30,%d2                 //of the sgl prec. limits

        lsll    %d2,%d3                 //shift g-r bits to MSB of d3

        movel   LOCAL_HI(%a0),%d2               //get word 2 for s-bit test

        andil   #0x0000003f,%d2         //s bit is the or of all other

        bnes    st_stky                 //bits to the right of g-r

        tstl    LOCAL_LO(%a0)           //test lower mantissa

        bnes    st_stky                 //if any are set, set sticky

        tstl    %d0                     //test original g,r,s

        bnes    st_stky                 //if any are set, set sticky

        bras    end_sd                  //if words 3 and 4 are clr, exit

grs_dbl:

        bfextu  LOCAL_LO(%a0){#21:#2},%d3       //dbl-prec. g-r are 2 bits right

        movel   #30,%d2                 //of the dbl prec. limits

        lsll    %d2,%d3                 //shift g-r bits to the MSB of d3

        movel   LOCAL_LO(%a0),%d2               //get lower mantissa  for s-bit test

        andil   #0x000001ff,%d2         //s bit is the or-ing of all

        bnes    st_stky                 //other bits to the right of g-r

        tstl    %d0                     //test word original g,r,s

        bnes    st_stky                 //if any are set, set sticky

        bras    end_sd                  //if clear, exit

st_stky:

        bset    #rnd_stky_bit,%d3

end_sd:

        movel   %d3,%d0                 //return grs to d0

        moveml  (%a7)+,%d2/%d3          //restore scratch registers

end_ext_grs:

        swap    %d1                     //restore d1 to original

        rts

//*******************  Local Equates

        .set    ad_1_sgl,0x00000100     //  constant to add 1 to l-bit in sgl prec

        .set    ad_1_dbl,0x00000800     //  constant to add 1 to l-bit in dbl prec

//Jump table for adding 1 to the l-bit indexed by rnd prec

add_to_l:

        .long   add_ext

        .long   add_sgl

        .long   add_dbl

        .long   add_dbl

//

//      ADD SINGLE

//

add_sgl:

        addl    #ad_1_sgl,LOCAL_HI(%a0)

        bccs    scc_clr                 //no mantissa overflow

        roxrw  LOCAL_HI(%a0)            //shift v-bit back in

        roxrw  LOCAL_HI+2(%a0)          //shift v-bit back in

        addw    #0x1,LOCAL_EX(%a0)      //and incr exponent

scc_clr:

        tstl    %d0                     //test for rs = 0

        bnes    sgl_done

        andiw  #0xfe00,LOCAL_HI+2(%a0)  //clear the l-bit

sgl_done:

        andil   #0xffffff00,LOCAL_HI(%a0) //truncate bits beyond sgl limit

        clrl    LOCAL_LO(%a0)           //clear d2

        rts

//

//      ADD EXTENDED

//

add_ext:

        addql  #1,LOCAL_LO(%a0)         //add 1 to l-bit

        bccs    xcc_clr                 //test for carry out

        addql  #1,LOCAL_HI(%a0)         //propagate carry

        bccs    xcc_clr

        roxrw  LOCAL_HI(%a0)            //mant is 0 so restore v-bit

        roxrw  LOCAL_HI+2(%a0)          //mant is 0 so restore v-bit

        roxrw   LOCAL_LO(%a0)

        roxrw   LOCAL_LO+2(%a0)

        addw    #0x1,LOCAL_EX(%a0)      //and inc exp

xcc_clr:

        tstl    %d0                     //test rs = 0

        bnes    add_ext_done

        andib   #0xfe,LOCAL_LO+3(%a0)   //clear the l bit

add_ext_done:

        rts

//

//      ADD DOUBLE

//

add_dbl:

        addl    #ad_1_dbl,LOCAL_LO(%a0)

        bccs    dcc_clr

        addql   #1,LOCAL_HI(%a0)                //propagate carry

        bccs    dcc_clr

        roxrw   LOCAL_HI(%a0)           //mant is 0 so restore v-bit

        roxrw   LOCAL_HI+2(%a0)         //mant is 0 so restore v-bit

        roxrw   LOCAL_LO(%a0)

        roxrw   LOCAL_LO+2(%a0)

        addw    #0x1,LOCAL_EX(%a0)      //incr exponent

dcc_clr:

        tstl    %d0                     //test for rs = 0

        bnes    dbl_done

        andiw   #0xf000,LOCAL_LO+2(%a0) //clear the l-bit

dbl_done:

        andil   #0xfffff800,LOCAL_LO(%a0) //truncate bits beyond dbl limit

        rts

error:

        rts

//

// Truncate all other bits

//

trunct:

        .long   end_rnd

        .long   sgl_done

        .long   dbl_done

        .long   dbl_done

truncate:

        lea     trunct,%a1

        movel   (%a1,%d1.w*4),%a1

        jmp     (%a1)

end_rnd:

        rts

//

//      NORMALIZE

//

// These routines (nrm_zero & nrm_set) normalize the unnorm.  This

// is done by shifting the mantissa left while decrementing the

// exponent.

//

// NRM_SET shifts and decrements until there is a 1 set in the integer

// bit of the mantissa (msb in d1).

//

// NRM_ZERO shifts and decrements until there is a 1 set in the integer

// bit of the mantissa (msb in d1) unless this would mean the exponent

// would go less than 0.  In that case the number becomes a denorm - the

// exponent (d0) is set to 0 and the mantissa (d1 & d2) is not

// normalized.

//

// Note that both routines have been optimized (for the worst case) and

// therefore do not have the easy to follow decrement/shift loop.

//

//      NRM_ZERO

//

//      Distance to first 1 bit in mantissa = X

//      Distance to 0 from exponent = Y

//      If X < Y

//      Then

//        nrm_set

//      Else

//        shift mantissa by Y

//        set exponent = 0

//

//input:

//      FP_SCR1 = exponent, ms mantissa part, ls mantissa part

//output:

//      L_SCR1{4} = fpte15 or ete15 bit

//

        .global nrm_zero

nrm_zero:

        movew   LOCAL_EX(%a0),%d0

        cmpw   #64,%d0          //see if exp > 64

        bmis    d0_less

        bsr     nrm_set         //exp > 64 so exp won't exceed 0

        rts

d0_less:

        moveml  %d2/%d3/%d5/%d6,-(%a7)

        movel   LOCAL_HI(%a0),%d1

        movel   LOCAL_LO(%a0),%d2

        bfffo   %d1{#0:#32},%d3 //get the distance to the first 1

//                              ;in ms mant

        beqs    ms_clr          //branch if no bits were set

        cmpw    %d3,%d0         //of X>Y

        bmis    greater         //then exp will go past 0 (neg) if

//                              ;it is just shifted

        bsr     nrm_set         //else exp won't go past 0

        moveml  (%a7)+,%d2/%d3/%d5/%d6

        rts

greater:

        movel   %d2,%d6         //save ls mant in d6

        lsll    %d0,%d2         //shift ls mant by count

        lsll    %d0,%d1         //shift ms mant by count

        movel   #32,%d5

        subl    %d0,%d5         //make op a denorm by shifting bits

        lsrl    %d5,%d6         //by the number in the exp, then

//                              ;set exp = 0.

        orl     %d6,%d1         //shift the ls mant bits into the ms mant

        movel   #0,%d0          //same as if decremented exp to 0

//                              ;while shifting

        movew   %d0,LOCAL_EX(%a0)

        movel   %d1,LOCAL_HI(%a0)

        movel   %d2,LOCAL_LO(%a0)

        moveml  (%a7)+,%d2/%d3/%d5/%d6

        rts

ms_clr:

        bfffo   %d2{#0:#32},%d3 //check if any bits set in ls mant

        beqs    all_clr         //branch if none set

        addw    #32,%d3

        cmpw    %d3,%d0         //if X>Y

        bmis    greater         //then branch

        bsr     nrm_set         //else exp won't go past 0

        moveml  (%a7)+,%d2/%d3/%d5/%d6

        rts

all_clr:

        movew   #0,LOCAL_EX(%a0)        //no mantissa bits set. Set exp = 0.

        moveml  (%a7)+,%d2/%d3/%d5/%d6

        rts

//

//      NRM_SET

//

        .global nrm_set

nrm_set:

        movel   %d7,-(%a7)

        bfffo   LOCAL_HI(%a0){#0:#32},%d7 //find first 1 in ms mant to d7)

        beqs    lower           //branch if ms mant is all 0's

        movel   %d6,-(%a7)

        subw    %d7,LOCAL_EX(%a0)       //sub exponent by count

        movel   LOCAL_HI(%a0),%d0       //d0 has ms mant

        movel   LOCAL_LO(%a0),%d1 //d1 has ls mant

        lsll    %d7,%d0         //shift first 1 to j bit position

        movel   %d1,%d6         //copy ls mant into d6

        lsll    %d7,%d6         //shift ls mant by count

        movel   %d6,LOCAL_LO(%a0)       //store ls mant into memory

        moveql  #32,%d6

        subl    %d7,%d6         //continue shift

        lsrl    %d6,%d1         //shift off all bits but those that will

//                              ;be shifted into ms mant

        orl     %d1,%d0         //shift the ls mant bits into the ms mant

        movel   %d0,LOCAL_HI(%a0)       //store ms mant into memory

        moveml  (%a7)+,%d7/%d6  //restore registers

        rts

//

// We get here if ms mant was = 0, and we assume ls mant has bits

// set (otherwise this would have been tagged a zero not a denorm).

//

lower:

        movew   LOCAL_EX(%a0),%d0       //d0 has exponent

        movel   LOCAL_LO(%a0),%d1       //d1 has ls mant

        subw    #32,%d0         //account for ms mant being all zeros

        bfffo   %d1{#0:#32},%d7 //find first 1 in ls mant to d7)

        subw    %d7,%d0         //subtract shift count from exp

        lsll    %d7,%d1         //shift first 1 to integer bit in ms mant

        movew   %d0,LOCAL_EX(%a0)       //store ms mant

        movel   %d1,LOCAL_HI(%a0)       //store exp

        clrl    LOCAL_LO(%a0)   //clear ls mant

        movel   (%a7)+,%d7

        rts

//

//      denorm --- denormalize an intermediate result

//

//      Used by underflow.

//

// Input:

//      a0       points to the operand to be denormalized

//               (in the internal extended format)

//

//      d0:      rounding precision

// Output:

//      a0       points to the denormalized result

//               (in the internal extended format)

//

//      d0      is guard,round,sticky

//

// d0 comes into this routine with the rounding precision. It

// is then loaded with the denormalized exponent threshold for the

// rounding precision.

//

        .global denorm

denorm:

        btstb   #6,LOCAL_EX(%a0)        //check for exponents between $7fff-$4000

        beqs    no_sgn_ext

        bsetb   #7,LOCAL_EX(%a0)        //sign extend if it is so

no_sgn_ext:

        cmpib   #0,%d0          //if 0 then extended precision

        bnes    not_ext         //else branch

        clrl    %d1             //load d1 with ext threshold

        clrl    %d0             //clear the sticky flag

        bsr     dnrm_lp         //denormalize the number

        tstb    %d1             //check for inex

        beq     no_inex         //if clr, no inex

        bras    dnrm_inex       //if set, set inex

not_ext:

        cmpil   #1,%d0          //if 1 then single precision

        beqs    load_sgl        //else must be 2, double prec

load_dbl:

        movew   #dbl_thresh,%d1 //put copy of threshold in d1

        movel   %d1,%d0         //copy d1 into d0

        subw    LOCAL_EX(%a0),%d0       //diff = threshold - exp

        cmpw    #67,%d0         //if diff > 67 (mant + grs bits)

        bpls    chk_stky        //then branch (all bits would be

//                              ; shifted off in denorm routine)

        clrl    %d0             //else clear the sticky flag

        bsr     dnrm_lp         //denormalize the number

        tstb    %d1             //check flag

        beqs    no_inex         //if clr, no inex

        bras    dnrm_inex       //if set, set inex

load_sgl:

        movew   #sgl_thresh,%d1 //put copy of threshold in d1

        movel   %d1,%d0         //copy d1 into d0

        subw    LOCAL_EX(%a0),%d0       //diff = threshold - exp

        cmpw    #67,%d0         //if diff > 67 (mant + grs bits)

        bpls    chk_stky        //then branch (all bits would be

//                              ; shifted off in denorm routine)

        clrl    %d0             //else clear the sticky flag

        bsr     dnrm_lp         //denormalize the number

        tstb    %d1             //check flag

        beqs    no_inex         //if clr, no inex

        bras    dnrm_inex       //if set, set inex

chk_stky:

        tstl    LOCAL_HI(%a0)   //check for any bits set

        bnes    set_stky

        tstl    LOCAL_LO(%a0)   //check for any bits set

        bnes    set_stky

        bras    clr_mant

set_stky:

        orl     #inx2a_mask,USER_FPSR(%a6) //set inex2/ainex

        movel   #0x20000000,%d0 //set sticky bit in return value

clr_mant:

        movew   %d1,LOCAL_EX(%a0)               //load exp with threshold

        movel   #0,LOCAL_HI(%a0)        //set d1 = 0 (ms mantissa)

        movel   #0,LOCAL_LO(%a0)                //set d2 = 0 (ms mantissa)

        rts

dnrm_inex:

        orl     #inx2a_mask,USER_FPSR(%a6) //set inex2/ainex

no_inex:

        rts

//

//      dnrm_lp --- normalize exponent/mantissa to specified threshold

//

// Input:

//      a0              points to the operand to be denormalized

//      d0{31:29}       initial guard,round,sticky

//      d1{15:0}        denormalization threshold

// Output:

//      a0              points to the denormalized operand

//      d0{31:29}       final guard,round,sticky

//      d1.b            inexact flag:  all ones means inexact result

//

// The LOCAL_LO and LOCAL_GRS parts of the value are copied to FP_SCR2

// so that bfext can be used to extract the new low part of the mantissa.

// Dnrm_lp can be called with a0 pointing to ETEMP or WBTEMP and there

// is no LOCAL_GRS scratch word following it on the fsave frame.

//

        .global dnrm_lp

dnrm_lp:

        movel   %d2,-(%sp)              //save d2 for temp use

        btstb   #E3,E_BYTE(%a6)         //test for type E3 exception

        beqs    not_E3                  //not type E3 exception

        bfextu  WBTEMP_GRS(%a6){#6:#3},%d2      //extract guard,round, sticky  bit

        movel   #29,%d0

        lsll    %d0,%d2                 //shift g,r,s to their positions

        movel   %d2,%d0

not_E3:

        movel   (%sp)+,%d2              //restore d2

        movel   LOCAL_LO(%a0),FP_SCR2+LOCAL_LO(%a6)

        movel   %d0,FP_SCR2+LOCAL_GRS(%a6)

        movel   %d1,%d0                 //copy the denorm threshold

        subw    LOCAL_EX(%a0),%d1               //d1 = threshold - uns exponent

        bles    no_lp                   //d1 <= 0

        cmpw    #32,%d1

        blts    case_1                  //0 = d1 < 32

        cmpw    #64,%d1

        blts    case_2                  //32 <= d1 < 64

        bra     case_3                  //d1 >= 64

//

// No normalization necessary

//

no_lp:

        clrb    %d1                     //set no inex2 reported

        movel   FP_SCR2+LOCAL_GRS(%a6),%d0      //restore original g,r,s

        rts

//

// case (0

//

case_1:

        movel   %d2,-(%sp)

        movew   %d0,LOCAL_EX(%a0)               //exponent = denorm threshold

        movel   #32,%d0

        subw    %d1,%d0                 //d0 = 32 - d1

        bfextu  LOCAL_EX(%a0){%d0:#32},%d2

        bfextu  %d2{%d1:%d0},%d2                //d2 = new LOCAL_HI

        bfextu  LOCAL_HI(%a0){%d0:#32},%d1      //d1 = new LOCAL_LO

        bfextu  FP_SCR2+LOCAL_LO(%a6){%d0:#32},%d0      //d0 = new G,R,S

        movel   %d2,LOCAL_HI(%a0)               //store new LOCAL_HI

        movel   %d1,LOCAL_LO(%a0)               //store new LOCAL_LO

        clrb    %d1

        bftst   %d0{#2:#30}

        beqs    c1nstky

        bsetl   #rnd_stky_bit,%d0

        st      %d1

c1nstky:

        movel   FP_SCR2+LOCAL_GRS(%a6),%d2      //restore original g,r,s

        andil   #0xe0000000,%d2         //clear all but G,R,S

        tstl    %d2                     //test if original G,R,S are clear

        beqs    grs_clear

        orl     #0x20000000,%d0         //set sticky bit in d0

grs_clear:

        andil   #0xe0000000,%d0         //clear all but G,R,S

        movel   (%sp)+,%d2

        rts

//

// case (32<=d1<64)

//

case_2:

        movel   %d2,-(%sp)

        movew   %d0,LOCAL_EX(%a0)               //unsigned exponent = threshold

        subw    #32,%d1                 //d1 now between 0 and 32

        movel   #32,%d0

        subw    %d1,%d0                 //d0 = 32 - d1

        bfextu  LOCAL_EX(%a0){%d0:#32},%d2

        bfextu  %d2{%d1:%d0},%d2                //d2 = new LOCAL_LO

        bfextu  LOCAL_HI(%a0){%d0:#32},%d1      //d1 = new G,R,S

        bftst   %d1{#2:#30}

        bnes    c2_sstky                //bra if sticky bit to be set

        bftst   FP_SCR2+LOCAL_LO(%a6){%d0:#32}

        bnes    c2_sstky                //bra if sticky bit to be set

        movel   %d1,%d0

        clrb    %d1

        bras    end_c2

c2_sstky:

        movel   %d1,%d0

        bsetl   #rnd_stky_bit,%d0

        st      %d1

end_c2:

        clrl    LOCAL_HI(%a0)           //store LOCAL_HI = 0

        movel   %d2,LOCAL_LO(%a0)               //store LOCAL_LO

        movel   FP_SCR2+LOCAL_GRS(%a6),%d2      //restore original g,r,s

        andil   #0xe0000000,%d2         //clear all but G,R,S

        tstl    %d2                     //test if original G,R,S are clear

        beqs    clear_grs

        orl     #0x20000000,%d0         //set sticky bit in d0

clear_grs:

        andil   #0xe0000000,%d0         //get rid of all but G,R,S

        movel   (%sp)+,%d2

        rts

//

// d1 >= 64 Force the exponent to be the denorm threshold with the

// correct sign.

//

case_3:

        movew   %d0,LOCAL_EX(%a0)

        tstw    LOCAL_SGN(%a0)

        bges    c3con

c3neg:

        orl     #0x80000000,LOCAL_EX(%a0)

c3con:

        cmpw    #64,%d1

        beqs    sixty_four

        cmpw    #65,%d1

        beqs    sixty_five

//

// Shift value is out of range.  Set d1 for inex2 flag and

// return a zero with the given threshold.

//

        clrl    LOCAL_HI(%a0)

        clrl    LOCAL_LO(%a0)

        movel   #0x20000000,%d0

        st      %d1

        rts

sixty_four:

        movel   LOCAL_HI(%a0),%d0

        bfextu  %d0{#2:#30},%d1

        andil   #0xc0000000,%d0

        bras    c3com

sixty_five:

        movel   LOCAL_HI(%a0),%d0

        bfextu  %d0{#1:#31},%d1

        andil   #0x80000000,%d0

        lsrl    #1,%d0                  //shift high bit into R bit

c3com:

        tstl    %d1

        bnes    c3ssticky

        tstl    LOCAL_LO(%a0)

        bnes    c3ssticky

        tstb    FP_SCR2+LOCAL_GRS(%a6)

        bnes    c3ssticky

        clrb    %d1

        bras    c3end

c3ssticky:

        bsetl   #rnd_stky_bit,%d0

        st      %d1

c3end:

        clrl    LOCAL_HI(%a0)

        clrl    LOCAL_LO(%a0)

        rts

        |end