OpenCores
URL https://opencores.org/ocsvn/or1k/or1k/trunk

Subversion Repositories or1k

[/] [or1k/] [trunk/] [rc203soc/] [sw/] [uClinux/] [arch/] [m68k/] [fpsp040/] [get_op.S] - Rev 1765

Compare with Previous | Blame | View Log

|
|       get_op.sa 3.6 5/19/92
|
|       get_op.sa 3.5 4/26/91
|
|  Description: This routine is called by the unsupported format/data
| type exception handler ('unsupp' - vector 55) and the unimplemented
| instruction exception handler ('unimp' - vector 11).  'get_op'
| determines the opclass (0, 2, or 3) and branches to the
| opclass handler routine.  See 68881/2 User's Manual table 4-11
| for a description of the opclasses.
|
| For UNSUPPORTED data/format (exception vector 55) and for
| UNIMPLEMENTED instructions (exception vector 11) the following
| applies:
|
| - For unnormalized numbers (opclass 0, 2, or 3) the
| number(s) is normalized and the operand type tag is updated.
|               
| - For a packed number (opclass 2) the number is unpacked and the
| operand type tag is updated.
|
| - For denormalized numbers (opclass 0 or 2) the number(s) is not
| changed but passed to the next module.  The next module for
| unimp is do_func, the next module for unsupp is res_func.
|
| For UNSUPPORTED data/format (exception vector 55) only the
| following applies:
|
| - If there is a move out with a packed number (opclass 3) the
| number is packed and written to user memory.  For the other
| opclasses the number(s) are written back to the fsave stack
| and the instruction is then restored back into the '040.  The
| '040 is then able to complete the instruction.
|
| For example:
| fadd.x fpm,fpn where the fpm contains an unnormalized number.
| The '040 takes an unsupported data trap and gets to this
| routine.  The number is normalized, put back on the stack and
| then an frestore is done to restore the instruction back into
| the '040.  The '040 then re-executes the fadd.x fpm,fpn with
| a normalized number in the source and the instruction is
| successful.
|               
| Next consider if in the process of normalizing the un-
| normalized number it becomes a denormalized number.  The
| routine which converts the unnorm to a norm (called mk_norm)
| detects this and tags the number as a denorm.  The routine
| res_func sees the denorm tag and converts the denorm to a
| norm.  The instruction is then restored back into the '040
| which re_executes the instruction.
|
|
|               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.

GET_OP:    |idnt    2,1 | Motorola 040 Floating Point Software Package

        |section        8

        .include "fpsp.h"

        .global PIRN,PIRZRM,PIRP
        .global SMALRN,SMALRZRM,SMALRP
        .global BIGRN,BIGRZRM,BIGRP

PIRN:
        .long 0x40000000,0xc90fdaa2,0x2168c235    |pi
PIRZRM:
        .long 0x40000000,0xc90fdaa2,0x2168c234    |pi
PIRP:
        .long 0x40000000,0xc90fdaa2,0x2168c235    |pi

|round to nearest
SMALRN:
        .long 0x3ffd0000,0x9a209a84,0xfbcff798    |log10(2)
        .long 0x40000000,0xadf85458,0xa2bb4a9a    |e
        .long 0x3fff0000,0xb8aa3b29,0x5c17f0bc    |log2(e)
        .long 0x3ffd0000,0xde5bd8a9,0x37287195    |log10(e)
        .long 0x00000000,0x00000000,0x00000000    |0.0
| round to zero;round to negative infinity
SMALRZRM:
        .long 0x3ffd0000,0x9a209a84,0xfbcff798    |log10(2)
        .long 0x40000000,0xadf85458,0xa2bb4a9a    |e
        .long 0x3fff0000,0xb8aa3b29,0x5c17f0bb    |log2(e)
        .long 0x3ffd0000,0xde5bd8a9,0x37287195    |log10(e)
        .long 0x00000000,0x00000000,0x00000000    |0.0
| round to positive infinity
SMALRP:
        .long 0x3ffd0000,0x9a209a84,0xfbcff799    |log10(2)
        .long 0x40000000,0xadf85458,0xa2bb4a9b    |e
        .long 0x3fff0000,0xb8aa3b29,0x5c17f0bc    |log2(e)
        .long 0x3ffd0000,0xde5bd8a9,0x37287195    |log10(e)
        .long 0x00000000,0x00000000,0x00000000    |0.0

|round to nearest
BIGRN:
        .long 0x3ffe0000,0xb17217f7,0xd1cf79ac    |ln(2)
        .long 0x40000000,0x935d8ddd,0xaaa8ac17    |ln(10)
        .long 0x3fff0000,0x80000000,0x00000000    |10 ^ 0

        .global PTENRN
PTENRN:
        .long 0x40020000,0xA0000000,0x00000000    |10 ^ 1
        .long 0x40050000,0xC8000000,0x00000000    |10 ^ 2
        .long 0x400C0000,0x9C400000,0x00000000    |10 ^ 4
        .long 0x40190000,0xBEBC2000,0x00000000    |10 ^ 8
        .long 0x40340000,0x8E1BC9BF,0x04000000    |10 ^ 16
        .long 0x40690000,0x9DC5ADA8,0x2B70B59E    |10 ^ 32
        .long 0x40D30000,0xC2781F49,0xFFCFA6D5    |10 ^ 64
        .long 0x41A80000,0x93BA47C9,0x80E98CE0    |10 ^ 128
        .long 0x43510000,0xAA7EEBFB,0x9DF9DE8E    |10 ^ 256
        .long 0x46A30000,0xE319A0AE,0xA60E91C7    |10 ^ 512
        .long 0x4D480000,0xC9767586,0x81750C17    |10 ^ 1024
        .long 0x5A920000,0x9E8B3B5D,0xC53D5DE5    |10 ^ 2048
        .long 0x75250000,0xC4605202,0x8A20979B    |10 ^ 4096
|round to minus infinity
BIGRZRM:
        .long 0x3ffe0000,0xb17217f7,0xd1cf79ab    |ln(2)
        .long 0x40000000,0x935d8ddd,0xaaa8ac16    |ln(10)
        .long 0x3fff0000,0x80000000,0x00000000    |10 ^ 0

        .global PTENRM
PTENRM:
        .long 0x40020000,0xA0000000,0x00000000    |10 ^ 1
        .long 0x40050000,0xC8000000,0x00000000    |10 ^ 2
        .long 0x400C0000,0x9C400000,0x00000000    |10 ^ 4
        .long 0x40190000,0xBEBC2000,0x00000000    |10 ^ 8
        .long 0x40340000,0x8E1BC9BF,0x04000000    |10 ^ 16
        .long 0x40690000,0x9DC5ADA8,0x2B70B59D    |10 ^ 32
        .long 0x40D30000,0xC2781F49,0xFFCFA6D5    |10 ^ 64
        .long 0x41A80000,0x93BA47C9,0x80E98CDF    |10 ^ 128
        .long 0x43510000,0xAA7EEBFB,0x9DF9DE8D    |10 ^ 256
        .long 0x46A30000,0xE319A0AE,0xA60E91C6    |10 ^ 512
        .long 0x4D480000,0xC9767586,0x81750C17    |10 ^ 1024
        .long 0x5A920000,0x9E8B3B5D,0xC53D5DE5    |10 ^ 2048
        .long 0x75250000,0xC4605202,0x8A20979A    |10 ^ 4096
|round to positive infinity
BIGRP:
        .long 0x3ffe0000,0xb17217f7,0xd1cf79ac    |ln(2)
        .long 0x40000000,0x935d8ddd,0xaaa8ac17    |ln(10)
        .long 0x3fff0000,0x80000000,0x00000000    |10 ^ 0

        .global PTENRP
PTENRP:
        .long 0x40020000,0xA0000000,0x00000000    |10 ^ 1
        .long 0x40050000,0xC8000000,0x00000000    |10 ^ 2
        .long 0x400C0000,0x9C400000,0x00000000    |10 ^ 4
        .long 0x40190000,0xBEBC2000,0x00000000    |10 ^ 8
        .long 0x40340000,0x8E1BC9BF,0x04000000    |10 ^ 16
        .long 0x40690000,0x9DC5ADA8,0x2B70B59E    |10 ^ 32
        .long 0x40D30000,0xC2781F49,0xFFCFA6D6    |10 ^ 64
        .long 0x41A80000,0x93BA47C9,0x80E98CE0    |10 ^ 128
        .long 0x43510000,0xAA7EEBFB,0x9DF9DE8E    |10 ^ 256
        .long 0x46A30000,0xE319A0AE,0xA60E91C7    |10 ^ 512
        .long 0x4D480000,0xC9767586,0x81750C18    |10 ^ 1024
        .long 0x5A920000,0x9E8B3B5D,0xC53D5DE6    |10 ^ 2048
        .long 0x75250000,0xC4605202,0x8A20979B    |10 ^ 4096

        |xref   nrm_zero
        |xref   decbin
        |xref   round

        .global    get_op
        .global    uns_getop
        .global    uni_getop
get_op:
        clrb    DY_MO_FLG(%a6)
        tstb    UFLG_TMP(%a6)   |test flag for unsupp/unimp state
        beqs    uni_getop

uns_getop:
        btstb   #direction_bit,CMDREG1B(%a6)
        bne     opclass3        |branch if a fmove out (any kind)
        btstb   #6,CMDREG1B(%a6)
        beqs    uns_notpacked

        bfextu  CMDREG1B(%a6){#3:#3},%d0
        cmpb    #3,%d0
        beq     pack_source     |check for a packed src op, branch if so
uns_notpacked:
        bsr     chk_dy_mo       |set the dyadic/monadic flag
        tstb    DY_MO_FLG(%a6)
        beqs    src_op_ck       |if monadic, go check src op
|                               ;else, check dst op (fall through)

        btstb   #7,DTAG(%a6)
        beqs    src_op_ck       |if dst op is norm, check src op
        bras    dst_ex_dnrm     |else, handle destination unnorm/dnrm

uni_getop:
        bfextu  CMDREG1B(%a6){#0:#6},%d0 |get opclass and src fields
        cmpil   #0x17,%d0               |if op class and size fields are $17, 
|                               ;it is FMOVECR; if not, continue
|
| If the instruction is fmovecr, exit get_op.  It is handled
| in do_func and smovecr.sa.
|
        bne     not_fmovecr     |handle fmovecr as an unimplemented inst
        rts

not_fmovecr:
        btstb   #E1,E_BYTE(%a6) |if set, there is a packed operand
        bne     pack_source     |check for packed src op, branch if so

| The following lines of are coded to optimize on normalized operands
        moveb   STAG(%a6),%d0
        orb     DTAG(%a6),%d0   |check if either of STAG/DTAG msb set
        bmis    dest_op_ck      |if so, some op needs to be fixed
        rts

dest_op_ck:
        btstb   #7,DTAG(%a6)    |check for unsupported data types in
        beqs    src_op_ck       |the destination, if not, check src op
        bsr     chk_dy_mo       |set dyadic/monadic flag
        tstb    DY_MO_FLG(%a6)  |
        beqs    src_op_ck       |if monadic, check src op
|
| At this point, destination has an extended denorm or unnorm.
|
dst_ex_dnrm:
        movew   FPTEMP_EX(%a6),%d0 |get destination exponent
        andiw   #0x7fff,%d0     |mask sign, check if exp = 0000
        beqs    src_op_ck       |if denorm then check source op.
|                               ;denorms are taken care of in res_func 
|                               ;(unsupp) or do_func (unimp)
|                               ;else unnorm fall through
        leal    FPTEMP(%a6),%a0 |point a0 to dop - used in mk_norm
        bsr     mk_norm         |go normalize - mk_norm returns:
|                               ;L_SCR1{7:5} = operand tag 
|                               ;       (000 = norm, 100 = denorm)
|                               ;L_SCR1{4} = fpte15 or ete15 
|                               ;       0 = exp >  $3fff
|                               ;       1 = exp <= $3fff
|                               ;and puts the normalized num back 
|                               ;on the fsave stack
|
        moveb L_SCR1(%a6),DTAG(%a6) |write the new tag & fpte15 
|                               ;to the fsave stack and fall 
|                               ;through to check source operand
|
src_op_ck:
        btstb   #7,STAG(%a6)
        beq     end_getop       |check for unsupported data types on the
|                               ;source operand
        btstb   #5,STAG(%a6)
        bnes    src_sd_dnrm     |if bit 5 set, handle sgl/dbl denorms
|
| At this point only unnorms or extended denorms are possible.
|
src_ex_dnrm:
        movew   ETEMP_EX(%a6),%d0 |get source exponent
        andiw   #0x7fff,%d0     |mask sign, check if exp = 0000
        beq     end_getop       |if denorm then exit, denorms are 
|                               ;handled in do_func
        leal    ETEMP(%a6),%a0  |point a0 to sop - used in mk_norm
        bsr     mk_norm         |go normalize - mk_norm returns:
|                               ;L_SCR1{7:5} = operand tag 
|                               ;       (000 = norm, 100 = denorm)
|                               ;L_SCR1{4} = fpte15 or ete15 
|                               ;       0 = exp >  $3fff
|                               ;       1 = exp <= $3fff
|                               ;and puts the normalized num back 
|                               ;on the fsave stack
|
        moveb   L_SCR1(%a6),STAG(%a6) |write the new tag & ete15 
        rts                     |end_getop

|
| At this point, only single or double denorms are possible.
| If the inst is not fmove, normalize the source.  If it is,
| do nothing to the input.
|
src_sd_dnrm:
        btstb   #4,CMDREG1B(%a6)        |differentiate between sgl/dbl denorm
        bnes    is_double
is_single:
        movew   #0x3f81,%d1     |write bias for sgl denorm
        bras    common          |goto the common code
is_double:
        movew   #0x3c01,%d1     |write the bias for a dbl denorm
common:
        btstb   #sign_bit,ETEMP_EX(%a6) |grab sign bit of mantissa
        beqs    pos     
        bset    #15,%d1         |set sign bit because it is negative
pos:
        movew   %d1,ETEMP_EX(%a6)
|                               ;put exponent on stack

        movew   CMDREG1B(%a6),%d1
        andw    #0xe3ff,%d1     |clear out source specifier
        orw     #0x0800,%d1     |set source specifier to extended prec
        movew   %d1,CMDREG1B(%a6)       |write back to the command word in stack
|                               ;this is needed to fix unsupp data stack
        leal    ETEMP(%a6),%a0  |point a0 to sop
        
        bsr     mk_norm         |convert sgl/dbl denorm to norm
        moveb   L_SCR1(%a6),STAG(%a6) |put tag into source tag reg - d0
        rts                     |end_getop
|
| At this point, the source is definitely packed, whether
| instruction is dyadic or monadic is still unknown
|
pack_source:
        movel   FPTEMP_LO(%a6),ETEMP(%a6)       |write ms part of packed 
|                               ;number to etemp slot
        bsr     chk_dy_mo       |set dyadic/monadic flag
        bsr     unpack

        tstb    DY_MO_FLG(%a6)
        beqs    end_getop       |if monadic, exit
|                               ;else, fix FPTEMP
pack_dya:
        bfextu  CMDREG1B(%a6){#6:#3},%d0 |extract dest fp reg
        movel   #7,%d1
        subl    %d0,%d1
        clrl    %d0
        bsetl   %d1,%d0         |set up d0 as a dynamic register mask
        fmovemx %d0,FPTEMP(%a6) |write to FPTEMP

        btstb   #7,DTAG(%a6)    |check dest tag for unnorm or denorm
        bne     dst_ex_dnrm     |else, handle the unnorm or ext denorm
|
| Dest is not denormalized.  Check for norm, and set fpte15 
| accordingly.
|
        moveb   DTAG(%a6),%d0
        andib   #0xf0,%d0               |strip to only dtag:fpte15
        tstb    %d0             |check for normalized value
        bnes    end_getop       |if inf/nan/zero leave get_op
        movew   FPTEMP_EX(%a6),%d0
        andiw   #0x7fff,%d0
        cmpiw   #0x3fff,%d0     |check if fpte15 needs setting
        bges    end_getop       |if >= $3fff, leave fpte15=0
        orb     #0x10,DTAG(%a6)
        bras    end_getop

|
| At this point, it is either an fmoveout packed, unnorm or denorm
|
opclass3:
        clrb    DY_MO_FLG(%a6)  |set dyadic/monadic flag to monadic
        bfextu  CMDREG1B(%a6){#4:#2},%d0
        cmpib   #3,%d0
        bne     src_ex_dnrm     |if not equal, must be unnorm or denorm
|                               ;else it is a packed move out
|                               ;exit
end_getop:
        rts

|
| Sets the DY_MO_FLG correctly. This is used only on if it is an
| unsupported data type exception.  Set if dyadic.
|
chk_dy_mo:
        movew   CMDREG1B(%a6),%d0       
        btstl   #5,%d0          |testing extension command word
        beqs    set_mon         |if bit 5 = 0 then monadic
        btstl   #4,%d0          |know that bit 5 = 1
        beqs    set_dya         |if bit 4 = 0 then dyadic
        andiw   #0x007f,%d0     |get rid of all but extension bits {6:0}
        cmpiw   #0x0038,%d0     |if extension = $38 then fcmp (dyadic)
        bnes    set_mon
set_dya:
        st      DY_MO_FLG(%a6)  |set the inst flag type to dyadic
        rts
set_mon:
        clrb    DY_MO_FLG(%a6)  |set the inst flag type to monadic
        rts
|
|       MK_NORM
|
| Normalizes unnormalized numbers, sets tag to norm or denorm, sets unfl
| exception if denorm.
|
| CASE opclass 0x0 unsupp
|       mk_norm till msb set
|       set tag = norm
|
| CASE opclass 0x0 unimp
|       mk_norm till msb set or exp = 0
|       if integer bit = 0
|          tag = denorm
|       else
|          tag = norm
|
| CASE opclass 011 unsupp
|       mk_norm till msb set or exp = 0
|       if integer bit = 0
|          tag = denorm
|          set unfl_nmcexe = 1
|       else
|          tag = norm
|
| if exp <= $3fff
|   set ete15 or fpte15 = 1
| else set ete15 or fpte15 = 0

| input:
|       a0 = points to operand to be normalized
| output:
|       L_SCR1{7:5} = operand tag (000 = norm, 100 = denorm)
|       L_SCR1{4}   = fpte15 or ete15 (0 = exp > $3fff, 1 = exp <=$3fff)
|       the normalized operand is placed back on the fsave stack
mk_norm:        
        clrl    L_SCR1(%a6)
        bclrb   #sign_bit,LOCAL_EX(%a0)
        sne     LOCAL_SGN(%a0)  |transform into internal extended format

        cmpib   #0x2c,1+EXC_VEC(%a6) |check if unimp
        bnes    uns_data        |branch if unsupp
        bsr     uni_inst        |call if unimp (opclass 0x0)
        bras    reload
uns_data:
        btstb   #direction_bit,CMDREG1B(%a6) |check transfer direction
        bnes    bit_set         |branch if set (opclass 011)
        bsr     uns_opx         |call if opclass 0x0
        bras    reload
bit_set:
        bsr     uns_op3         |opclass 011
reload:
        cmpw    #0x3fff,LOCAL_EX(%a0) |if exp > $3fff
        bgts    end_mk          |   fpte15/ete15 already set to 0
        bsetb   #4,L_SCR1(%a6)  |else set fpte15/ete15 to 1
|                               ;calling routine actually sets the 
|                               ;value on the stack (along with the 
|                               ;tag), since this routine doesn't 
|                               ;know if it should set ete15 or fpte15
|                               ;ie, it doesn't know if this is the 
|                               ;src op or dest op.
end_mk:
        bfclr   LOCAL_SGN(%a0){#0:#8}
        beqs    end_mk_pos
        bsetb   #sign_bit,LOCAL_EX(%a0) |convert back to IEEE format
end_mk_pos:
        rts
|
|     CASE opclass 011 unsupp
|
uns_op3:
        bsr     nrm_zero        |normalize till msb = 1 or exp = zero
        btstb   #7,LOCAL_HI(%a0)        |if msb = 1
        bnes    no_unfl         |then branch
set_unfl:
        orw     #dnrm_tag,L_SCR1(%a6) |set denorm tag
        bsetb   #unfl_bit,FPSR_EXCEPT(%a6) |set unfl exception bit
no_unfl:
        rts
|
|     CASE opclass 0x0 unsupp
|
uns_opx:
        bsr     nrm_zero        |normalize the number
        btstb   #7,LOCAL_HI(%a0)        |check if integer bit (j-bit) is set 
        beqs    uns_den         |if clear then now have a denorm
uns_nrm:
        orb     #norm_tag,L_SCR1(%a6) |set tag to norm
        rts
uns_den:
        orb     #dnrm_tag,L_SCR1(%a6) |set tag to denorm
        rts
|
|     CASE opclass 0x0 unimp
|
uni_inst:
        bsr     nrm_zero
        btstb   #7,LOCAL_HI(%a0)        |check if integer bit (j-bit) is set 
        beqs    uni_den         |if clear then now have a denorm
uni_nrm:
        orb     #norm_tag,L_SCR1(%a6) |set tag to norm
        rts
uni_den:
        orb     #dnrm_tag,L_SCR1(%a6) |set tag to denorm
        rts

|
|       Decimal to binary conversion
|
| Special cases of inf and NaNs are completed outside of decbin.  
| If the input is an snan, the snan bit is not set.
| 
| input:
|       ETEMP(a6)       - points to packed decimal string in memory
| output:
|       fp0     - contains packed string converted to extended precision
|       ETEMP   - same as fp0
unpack:
        movew   CMDREG1B(%a6),%d0       |examine command word, looking for fmove's
        andw    #0x3b,%d0
        beq     move_unpack     |special handling for fmove: must set FPSR_CC

        movew   ETEMP(%a6),%d0  |get word with inf information
        bfextu  %d0{#20:#12},%d1        |get exponent into d1
        cmpiw   #0x0fff,%d1     |test for inf or NaN
        bnes    try_zero        |if not equal, it is not special
        bfextu  %d0{#17:#3},%d1 |get SE and y bits into d1
        cmpiw   #7,%d1          |SE and y bits must be on for special
        bnes    try_zero        |if not on, it is not special
|input is of the special cases of inf and NaN
        tstl    ETEMP_HI(%a6)   |check ms mantissa
        bnes    fix_nan         |if non-zero, it is a NaN
        tstl    ETEMP_LO(%a6)   |check ls mantissa
        bnes    fix_nan         |if non-zero, it is a NaN
        bra     finish          |special already on stack
fix_nan:
        btstb   #signan_bit,ETEMP_HI(%a6) |test for snan
        bne     finish
        orl     #snaniop_mask,USER_FPSR(%a6) |always set snan if it is so
        bra     finish
try_zero:
        movew   ETEMP_EX+2(%a6),%d0 |get word 4
        andiw   #0x000f,%d0     |clear all but last ni(y)bble
        tstw    %d0             |check for zero.
        bne     not_spec
        tstl    ETEMP_HI(%a6)   |check words 3 and 2
        bne     not_spec
        tstl    ETEMP_LO(%a6)   |check words 1 and 0
        bne     not_spec
        tstl    ETEMP(%a6)      |test sign of the zero
        bges    pos_zero
        movel   #0x80000000,ETEMP(%a6) |write neg zero to etemp
        clrl    ETEMP_HI(%a6)
        clrl    ETEMP_LO(%a6)
        bra     finish
pos_zero:
        clrl    ETEMP(%a6)
        clrl    ETEMP_HI(%a6)
        clrl    ETEMP_LO(%a6)
        bra     finish

not_spec:
        fmovemx %fp0-%fp1,-(%a7)        |save fp0 - decbin returns in it
        bsr     decbin
        fmovex %fp0,ETEMP(%a6)  |put the unpacked sop in the fsave stack
        fmovemx (%a7)+,%fp0-%fp1
        fmovel  #0,%FPSR                |clr fpsr from decbin
        bra     finish

|
| Special handling for packed move in:  Same results as all other
| packed cases, but we must set the FPSR condition codes properly.
|
move_unpack:
        movew   ETEMP(%a6),%d0  |get word with inf information
        bfextu  %d0{#20:#12},%d1        |get exponent into d1
        cmpiw   #0x0fff,%d1     |test for inf or NaN
        bnes    mtry_zero       |if not equal, it is not special
        bfextu  %d0{#17:#3},%d1 |get SE and y bits into d1
        cmpiw   #7,%d1          |SE and y bits must be on for special
        bnes    mtry_zero       |if not on, it is not special
|input is of the special cases of inf and NaN
        tstl    ETEMP_HI(%a6)   |check ms mantissa
        bnes    mfix_nan                |if non-zero, it is a NaN
        tstl    ETEMP_LO(%a6)   |check ls mantissa
        bnes    mfix_nan                |if non-zero, it is a NaN
|input is inf
        orl     #inf_mask,USER_FPSR(%a6) |set I bit
        tstl    ETEMP(%a6)      |check sign
        bge     finish
        orl     #neg_mask,USER_FPSR(%a6) |set N bit
        bra     finish          |special already on stack
mfix_nan:
        orl     #nan_mask,USER_FPSR(%a6) |set NaN bit
        moveb   #nan_tag,STAG(%a6)      |set stag to NaN
        btstb   #signan_bit,ETEMP_HI(%a6) |test for snan
        bnes    mn_snan
        orl     #snaniop_mask,USER_FPSR(%a6) |set snan bit
        btstb   #snan_bit,FPCR_ENABLE(%a6) |test for snan enabled
        bnes    mn_snan
        bsetb   #signan_bit,ETEMP_HI(%a6) |force snans to qnans
mn_snan:
        tstl    ETEMP(%a6)      |check for sign
        bge     finish          |if clr, go on
        orl     #neg_mask,USER_FPSR(%a6) |set N bit
        bra     finish

mtry_zero:
        movew   ETEMP_EX+2(%a6),%d0 |get word 4
        andiw   #0x000f,%d0     |clear all but last ni(y)bble
        tstw    %d0             |check for zero.
        bnes    mnot_spec
        tstl    ETEMP_HI(%a6)   |check words 3 and 2
        bnes    mnot_spec
        tstl    ETEMP_LO(%a6)   |check words 1 and 0
        bnes    mnot_spec
        tstl    ETEMP(%a6)      |test sign of the zero
        bges    mpos_zero
        orl     #neg_mask+z_mask,USER_FPSR(%a6) |set N and Z
        movel   #0x80000000,ETEMP(%a6) |write neg zero to etemp
        clrl    ETEMP_HI(%a6)
        clrl    ETEMP_LO(%a6)
        bras    finish
mpos_zero:
        orl     #z_mask,USER_FPSR(%a6) |set Z
        clrl    ETEMP(%a6)
        clrl    ETEMP_HI(%a6)
        clrl    ETEMP_LO(%a6)
        bras    finish

mnot_spec:
        fmovemx %fp0-%fp1,-(%a7)        |save fp0 ,fp1 - decbin returns in fp0
        bsr     decbin
        fmovex %fp0,ETEMP(%a6)
|                               ;put the unpacked sop in the fsave stack
        fmovemx (%a7)+,%fp0-%fp1

finish:
        movew   CMDREG1B(%a6),%d0       |get the command word
        andw    #0xfbff,%d0     |change the source specifier field to 
|                               ;extended (was packed).
        movew   %d0,CMDREG1B(%a6)       |write command word back to fsave stack
|                               ;we need to do this so the 040 will 
|                               ;re-execute the inst. without taking 
|                               ;another packed trap.

fix_stag:
|Converted result is now in etemp on fsave stack, now set the source 
|tag (stag) 
|       if (ete =$7fff) then INF or NAN
|               if (etemp = $x.0----0) then
|                       stag = INF
|               else
|                       stag = NAN
|       else
|               if (ete = $0000) then
|                       stag = ZERO
|               else
|                       stag = NORM
|
| Note also that the etemp_15 bit (just right of the stag) must
| be set accordingly.  
|
        movew           ETEMP_EX(%a6),%d1
        andiw           #0x7fff,%d1   |strip sign
        cmpw            #0x7fff,%d1
        bnes            z_or_nrm
        movel           ETEMP_HI(%a6),%d1
        bnes            is_nan
        movel           ETEMP_LO(%a6),%d1
        bnes            is_nan
is_inf:
        moveb           #0x40,STAG(%a6)
        movel           #0x40,%d0
        rts
is_nan:
        moveb           #0x60,STAG(%a6)
        movel           #0x60,%d0
        rts
z_or_nrm:
        tstw            %d1  
        bnes            is_nrm
is_zro:
| For a zero, set etemp_15
        moveb           #0x30,STAG(%a6)
        movel           #0x20,%d0
        rts
is_nrm:
| For a norm, check if the exp <= $3fff; if so, set etemp_15
        cmpiw           #0x3fff,%d1
        bles            set_bit15
        moveb           #0,STAG(%a6)
        bras            end_is_nrm
set_bit15:
        moveb           #0x10,STAG(%a6)
end_is_nrm:
        movel           #0,%d0
end_fix:
        rts
 
end_get:
        rts
        |end

Compare with Previous | Blame | View Log

powered by: WebSVN 2.1.0

© copyright 1999-2024 OpenCores.org, equivalent to Oliscience, all rights reserved. OpenCores®, registered trademark.