|
|       x_store.sa 3.2 1/24/91
|
|       store --- store operand to memory or register
|
|       Used by underflow and overflow handlers.
|
|       a6 = points to fp value to be stored.
|

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

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

        |section        8

fpreg_mask:
        .byte   0x80,0x40,0x20,0x10,0x08,0x04,0x02,0x01

#include "fpsp.h"

        |xref   mem_write
        |xref   get_fline
        |xref   g_opcls
        |xref   g_dfmtou
        |xref   reg_dest

        .global dest_ext
        .global dest_dbl
        .global dest_sgl

        .global store
store:
        btstb   #E3,E_BYTE(%a6)
        beqs    E1_sto
E3_sto:
        movel   CMDREG3B(%a6),%d0
        bfextu  %d0{#6:#3},%d0          |isolate dest. reg from cmdreg3b
sto_fp:
        lea     fpreg_mask,%a1
        moveb   (%a1,%d0.w),%d0         |convert reg# to dynamic register mask
        tstb    LOCAL_SGN(%a0)
        beqs    is_pos
        bsetb   #sign_bit,LOCAL_EX(%a0)
is_pos:
        fmovemx (%a0),%d0               |move to correct register
|
|       if fp0-fp3 is being modified, we must put a copy
|       in the USER_FPn variable on the stack because all exception
|       handlers restore fp0-fp3 from there.
|
        cmpb    #0x80,%d0
        bnes    not_fp0
        fmovemx %fp0-%fp0,USER_FP0(%a6)
        rts
not_fp0:
        cmpb    #0x40,%d0
        bnes    not_fp1
        fmovemx %fp1-%fp1,USER_FP1(%a6)
        rts
not_fp1:
        cmpb    #0x20,%d0
        bnes    not_fp2
        fmovemx %fp2-%fp2,USER_FP2(%a6)
        rts
not_fp2:
        cmpb    #0x10,%d0
        bnes    not_fp3
        fmovemx %fp3-%fp3,USER_FP3(%a6)
        rts
not_fp3:
        rts

E1_sto:
        bsrl    g_opcls         |returns opclass in d0
        cmpib   #3,%d0
        beq     opc011          |branch if opclass 3
        movel   CMDREG1B(%a6),%d0
        bfextu  %d0{#6:#3},%d0  |extract destination register
        bras    sto_fp

opc011:
        bsrl    g_dfmtou        |returns dest format in d0
|                               ;ext=00, sgl=01, dbl=10
        movel   %a0,%a1         |save source addr in a1
        movel   EXC_EA(%a6),%a0 |get the address
        cmpil   #0,%d0          |if dest format is extended
        beq     dest_ext        |then branch
        cmpil   #1,%d0          |if dest format is single
        beq     dest_sgl        |then branch
|
|       fall through to dest_dbl
|

|
|       dest_dbl --- write double precision value to user space
|
|Input
|       a0 -> destination address
|       a1 -> source in extended precision
|Output
|       a0 -> destroyed
|       a1 -> destroyed
|       d0 -> 0
|
|Changes extended precision to double precision.
| Note: no attempt is made to round the extended value to double.
|       dbl_sign = ext_sign
|       dbl_exp = ext_exp - $3fff(ext bias) + $7ff(dbl bias)
|       get rid of ext integer bit
|       dbl_mant = ext_mant{62:12}
|
|               ---------------   ---------------    ---------------
|  extended ->  |s|    exp    |   |1| ms mant   |    | ls mant     |
|               ---------------   ---------------    ---------------
|                95         64    63 62       32      31     11   0
|                                    |                       |
|                                    |                       |
|                                    |                       |
|                                    v                       v
|                             ---------------   ---------------
|  double   ->                |s|exp| mant  |   |  mant       |
|                             ---------------   ---------------
|                             63     51   32   31              0
|
dest_dbl:
        clrl    %d0             |clear d0
        movew   LOCAL_EX(%a1),%d0       |get exponent
        subw    #0x3fff,%d0     |subtract extended precision bias
        cmpw    #0x4000,%d0     |check if inf
        beqs    inf             |if so, special case
        addw    #0x3ff,%d0      |add double precision bias
        swap    %d0             |d0 now in upper word
        lsll    #4,%d0          |d0 now in proper place for dbl prec exp
        tstb    LOCAL_SGN(%a1)
        beqs    get_mant        |if positive, go process mantissa
        bsetl   #31,%d0         |if negative, put in sign information
|                               ; before continuing
        bras    get_mant        |go process mantissa
inf:
        movel   #0x7ff00000,%d0 |load dbl inf exponent
        clrl    LOCAL_HI(%a1)   |clear msb
        tstb    LOCAL_SGN(%a1)
        beqs    dbl_inf         |if positive, go ahead and write it
        bsetl   #31,%d0         |if negative put in sign information
dbl_inf:
        movel   %d0,LOCAL_EX(%a1)       |put the new exp back on the stack
        bras    dbl_wrt
get_mant:
        movel   LOCAL_HI(%a1),%d1       |get ms mantissa
        bfextu  %d1{#1:#20},%d1 |get upper 20 bits of ms
        orl     %d1,%d0         |put these bits in ms word of double
        movel   %d0,LOCAL_EX(%a1)       |put the new exp back on the stack
        movel   LOCAL_HI(%a1),%d1       |get ms mantissa
        movel   #21,%d0         |load shift count
        lsll    %d0,%d1         |put lower 11 bits in upper bits
        movel   %d1,LOCAL_HI(%a1)       |build lower lword in memory
        movel   LOCAL_LO(%a1),%d1       |get ls mantissa
        bfextu  %d1{#0:#21},%d0 |get ls 21 bits of double
        orl     %d0,LOCAL_HI(%a1)       |put them in double result
dbl_wrt:
        movel   #0x8,%d0                |byte count for double precision number
        exg     %a0,%a1         |a0=supervisor source, a1=user dest
        bsrl    mem_write       |move the number to the user's memory
        rts
|
|       dest_sgl --- write single precision value to user space
|
|Input
|       a0 -> destination address
|       a1 -> source in extended precision
|
|Output
|       a0 -> destroyed
|       a1 -> destroyed
|       d0 -> 0
|
|Changes extended precision to single precision.
|       sgl_sign = ext_sign
|       sgl_exp = ext_exp - $3fff(ext bias) + $7f(sgl bias)
|       get rid of ext integer bit
|       sgl_mant = ext_mant{62:12}
|
|               ---------------   ---------------    ---------------
|  extended ->  |s|    exp    |   |1| ms mant   |    | ls mant     |
|               ---------------   ---------------    ---------------
|                95         64    63 62    40 32      31     12   0
|                                    |     |
|                                    |     |
|                                    |     |
|                                    v     v
|                             ---------------
|  single   ->                |s|exp| mant  |
|                             ---------------
|                             31     22     0
|
dest_sgl:
        clrl    %d0
        movew   LOCAL_EX(%a1),%d0       |get exponent
        subw    #0x3fff,%d0     |subtract extended precision bias
        cmpw    #0x4000,%d0     |check if inf
        beqs    sinf            |if so, special case
        addw    #0x7f,%d0               |add single precision bias
        swap    %d0             |put exp in upper word of d0
        lsll    #7,%d0          |shift it into single exp bits
        tstb    LOCAL_SGN(%a1)
        beqs    get_sman        |if positive, continue
        bsetl   #31,%d0         |if negative, put in sign first
        bras    get_sman        |get mantissa
sinf:
        movel   #0x7f800000,%d0 |load single inf exp to d0
        tstb    LOCAL_SGN(%a1)
        beqs    sgl_wrt         |if positive, continue
        bsetl   #31,%d0         |if negative, put in sign info
        bras    sgl_wrt

get_sman:
        movel   LOCAL_HI(%a1),%d1       |get ms mantissa
        bfextu  %d1{#1:#23},%d1 |get upper 23 bits of ms
        orl     %d1,%d0         |put these bits in ms word of single

sgl_wrt:
        movel   %d0,L_SCR1(%a6) |put the new exp back on the stack
        movel   #0x4,%d0                |byte count for single precision number
        tstl    %a0             |users destination address
        beqs    sgl_Dn          |destination is a data register
        exg     %a0,%a1         |a0=supervisor source, a1=user dest
        leal    L_SCR1(%a6),%a0 |point a0 to data
        bsrl    mem_write       |move the number to the user's memory
        rts
sgl_Dn:
        bsrl    get_fline       |returns fline word in d0
        andw    #0x7,%d0                |isolate register number
        movel   %d0,%d1         |d1 has size:reg formatted for reg_dest
        orl     #0x10,%d1               |reg_dest wants size added to reg#
        bral    reg_dest        |size is X, rts in reg_dest will
|                               ;return to caller of dest_sgl

dest_ext:
        tstb    LOCAL_SGN(%a1)  |put back sign into exponent word
        beqs    dstx_cont
        bsetb   #sign_bit,LOCAL_EX(%a1)
dstx_cont:
        clrb    LOCAL_SGN(%a1)  |clear out the sign byte

        movel   #0x0c,%d0               |byte count for extended number
        exg     %a0,%a1         |a0=supervisor source, a1=user dest
        bsrl    mem_write       |move the number to the user's memory
        rts

        |end