forked from Qortal/Brooklyn
You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
558 lines
14 KiB
558 lines
14 KiB
| |
|
| do_func.sa 3.4 2/18/91 |
|
| |
|
| Do_func performs the unimplemented operation. The operation |
|
| to be performed is determined from the lower 7 bits of the |
|
| extension word (except in the case of fmovecr and fsincos). |
|
| The opcode and tag bits form an index into a jump table in |
|
| tbldo.sa. Cases of zero, infinity and NaN are handled in |
|
| do_func by forcing the default result. Normalized and |
|
| denormalized (there are no unnormalized numbers at this |
|
| point) are passed onto the emulation code. |
|
| |
|
| CMDREG1B and STAG are extracted from the fsave frame |
|
| and combined to form the table index. The function called |
|
| will start with a0 pointing to the ETEMP operand. Dyadic |
|
| functions can find FPTEMP at -12(a0). |
|
| |
|
| Called functions return their result in fp0. Sincos returns |
|
| sin(x) in fp0 and cos(x) in fp1. |
|
| |
|
|
|
| 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. |
|
|
|
DO_FUNC: |idnt 2,1 | Motorola 040 Floating Point Software Package |
|
|
|
|section 8 |
|
|
|
#include "fpsp.h" |
|
|
|
|xref t_dz2 |
|
|xref t_operr |
|
|xref t_inx2 |
|
|xref t_resdnrm |
|
|xref dst_nan |
|
|xref src_nan |
|
|xref nrm_set |
|
|xref sto_cos |
|
|
|
|xref tblpre |
|
|xref slognp1,slogn,slog10,slog2 |
|
|xref slognd,slog10d,slog2d |
|
|xref smod,srem |
|
|xref sscale |
|
|xref smovcr |
|
|
|
PONE: .long 0x3fff0000,0x80000000,0x00000000 |+1 |
|
MONE: .long 0xbfff0000,0x80000000,0x00000000 |-1 |
|
PZERO: .long 0x00000000,0x00000000,0x00000000 |+0 |
|
MZERO: .long 0x80000000,0x00000000,0x00000000 |-0 |
|
PINF: .long 0x7fff0000,0x00000000,0x00000000 |+inf |
|
MINF: .long 0xffff0000,0x00000000,0x00000000 |-inf |
|
QNAN: .long 0x7fff0000,0xffffffff,0xffffffff |non-signaling nan |
|
PPIBY2: .long 0x3FFF0000,0xC90FDAA2,0x2168C235 |+PI/2 |
|
MPIBY2: .long 0xbFFF0000,0xC90FDAA2,0x2168C235 |-PI/2 |
|
|
|
.global do_func |
|
do_func: |
|
clrb CU_ONLY(%a6) |
|
| |
|
| Check for fmovecr. It does not follow the format of fp gen |
|
| unimplemented instructions. The test is on the upper 6 bits; |
|
| if they are $17, the inst is fmovecr. Call entry smovcr |
|
| directly. |
|
| |
|
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 |
|
bnes not_fmovecr |
|
jmp smovcr |fmovecr; jmp directly to emulation |
|
|
|
not_fmovecr: |
|
movew CMDREG1B(%a6),%d0 |
|
andl #0x7F,%d0 |
|
cmpil #0x38,%d0 |if the extension is >= $38, |
|
bge serror |it is illegal |
|
bfextu STAG(%a6){#0:#3},%d1 |
|
lsll #3,%d0 |make room for STAG |
|
addl %d1,%d0 |combine for final index into table |
|
leal tblpre,%a1 |start of monster jump table |
|
movel (%a1,%d0.w*4),%a1 |real target address |
|
leal ETEMP(%a6),%a0 |a0 is pointer to src op |
|
movel USER_FPCR(%a6),%d1 |
|
andl #0xFF,%d1 | discard all but rounding mode/prec |
|
fmovel #0,%fpcr |
|
jmp (%a1) |
|
| |
|
| ERROR |
|
| |
|
.global serror |
|
serror: |
|
st STORE_FLG(%a6) |
|
rts |
|
| |
|
| These routines load forced values into fp0. They are called |
|
| by index into tbldo. |
|
| |
|
| Load a signed zero to fp0 and set inex2/ainex |
|
| |
|
.global snzrinx |
|
snzrinx: |
|
btstb #sign_bit,LOCAL_EX(%a0) |get sign of source operand |
|
bnes ld_mzinx |if negative, branch |
|
bsr ld_pzero |bsr so we can return and set inx |
|
bra t_inx2 |now, set the inx for the next inst |
|
ld_mzinx: |
|
bsr ld_mzero |if neg, load neg zero, return here |
|
bra t_inx2 |now, set the inx for the next inst |
|
| |
|
| Load a signed zero to fp0; do not set inex2/ainex |
|
| |
|
.global szero |
|
szero: |
|
btstb #sign_bit,LOCAL_EX(%a0) |get sign of source operand |
|
bne ld_mzero |if neg, load neg zero |
|
bra ld_pzero |load positive zero |
|
| |
|
| Load a signed infinity to fp0; do not set inex2/ainex |
|
| |
|
.global sinf |
|
sinf: |
|
btstb #sign_bit,LOCAL_EX(%a0) |get sign of source operand |
|
bne ld_minf |if negative branch |
|
bra ld_pinf |
|
| |
|
| Load a signed one to fp0; do not set inex2/ainex |
|
| |
|
.global sone |
|
sone: |
|
btstb #sign_bit,LOCAL_EX(%a0) |check sign of source |
|
bne ld_mone |
|
bra ld_pone |
|
| |
|
| Load a signed pi/2 to fp0; do not set inex2/ainex |
|
| |
|
.global spi_2 |
|
spi_2: |
|
btstb #sign_bit,LOCAL_EX(%a0) |check sign of source |
|
bne ld_mpi2 |
|
bra ld_ppi2 |
|
| |
|
| Load either a +0 or +inf for plus/minus operand |
|
| |
|
.global szr_inf |
|
szr_inf: |
|
btstb #sign_bit,LOCAL_EX(%a0) |check sign of source |
|
bne ld_pzero |
|
bra ld_pinf |
|
| |
|
| Result is either an operr or +inf for plus/minus operand |
|
| [Used by slogn, slognp1, slog10, and slog2] |
|
| |
|
.global sopr_inf |
|
sopr_inf: |
|
btstb #sign_bit,LOCAL_EX(%a0) |check sign of source |
|
bne t_operr |
|
bra ld_pinf |
|
| |
|
| FLOGNP1 |
|
| |
|
.global sslognp1 |
|
sslognp1: |
|
fmovemx (%a0),%fp0-%fp0 |
|
fcmpb #-1,%fp0 |
|
fbgt slognp1 |
|
fbeq t_dz2 |if = -1, divide by zero exception |
|
fmovel #0,%FPSR |clr N flag |
|
bra t_operr |take care of operands < -1 |
|
| |
|
| FETOXM1 |
|
| |
|
.global setoxm1i |
|
setoxm1i: |
|
btstb #sign_bit,LOCAL_EX(%a0) |check sign of source |
|
bne ld_mone |
|
bra ld_pinf |
|
| |
|
| FLOGN |
|
| |
|
| Test for 1.0 as an input argument, returning +zero. Also check |
|
| the sign and return operr if negative. |
|
| |
|
.global sslogn |
|
sslogn: |
|
btstb #sign_bit,LOCAL_EX(%a0) |
|
bne t_operr |take care of operands < 0 |
|
cmpiw #0x3fff,LOCAL_EX(%a0) |test for 1.0 input |
|
bne slogn |
|
cmpil #0x80000000,LOCAL_HI(%a0) |
|
bne slogn |
|
tstl LOCAL_LO(%a0) |
|
bne slogn |
|
fmovex PZERO,%fp0 |
|
rts |
|
|
|
.global sslognd |
|
sslognd: |
|
btstb #sign_bit,LOCAL_EX(%a0) |
|
beq slognd |
|
bra t_operr |take care of operands < 0 |
|
|
|
| |
|
| FLOG10 |
|
| |
|
.global sslog10 |
|
sslog10: |
|
btstb #sign_bit,LOCAL_EX(%a0) |
|
bne t_operr |take care of operands < 0 |
|
cmpiw #0x3fff,LOCAL_EX(%a0) |test for 1.0 input |
|
bne slog10 |
|
cmpil #0x80000000,LOCAL_HI(%a0) |
|
bne slog10 |
|
tstl LOCAL_LO(%a0) |
|
bne slog10 |
|
fmovex PZERO,%fp0 |
|
rts |
|
|
|
.global sslog10d |
|
sslog10d: |
|
btstb #sign_bit,LOCAL_EX(%a0) |
|
beq slog10d |
|
bra t_operr |take care of operands < 0 |
|
|
|
| |
|
| FLOG2 |
|
| |
|
.global sslog2 |
|
sslog2: |
|
btstb #sign_bit,LOCAL_EX(%a0) |
|
bne t_operr |take care of operands < 0 |
|
cmpiw #0x3fff,LOCAL_EX(%a0) |test for 1.0 input |
|
bne slog2 |
|
cmpil #0x80000000,LOCAL_HI(%a0) |
|
bne slog2 |
|
tstl LOCAL_LO(%a0) |
|
bne slog2 |
|
fmovex PZERO,%fp0 |
|
rts |
|
|
|
.global sslog2d |
|
sslog2d: |
|
btstb #sign_bit,LOCAL_EX(%a0) |
|
beq slog2d |
|
bra t_operr |take care of operands < 0 |
|
|
|
| |
|
| FMOD |
|
| |
|
pmodt: |
|
| ;$21 fmod |
|
| ;dtag,stag |
|
.long smod | 00,00 norm,norm = normal |
|
.long smod_oper | 00,01 norm,zero = nan with operr |
|
.long smod_fpn | 00,10 norm,inf = fpn |
|
.long smod_snan | 00,11 norm,nan = nan |
|
.long smod_zro | 01,00 zero,norm = +-zero |
|
.long smod_oper | 01,01 zero,zero = nan with operr |
|
.long smod_zro | 01,10 zero,inf = +-zero |
|
.long smod_snan | 01,11 zero,nan = nan |
|
.long smod_oper | 10,00 inf,norm = nan with operr |
|
.long smod_oper | 10,01 inf,zero = nan with operr |
|
.long smod_oper | 10,10 inf,inf = nan with operr |
|
.long smod_snan | 10,11 inf,nan = nan |
|
.long smod_dnan | 11,00 nan,norm = nan |
|
.long smod_dnan | 11,01 nan,zero = nan |
|
.long smod_dnan | 11,10 nan,inf = nan |
|
.long smod_dnan | 11,11 nan,nan = nan |
|
|
|
.global pmod |
|
pmod: |
|
clrb FPSR_QBYTE(%a6) | clear quotient field |
|
bfextu STAG(%a6){#0:#3},%d0 |stag = d0 |
|
bfextu DTAG(%a6){#0:#3},%d1 |dtag = d1 |
|
|
|
| |
|
| Alias extended denorms to norms for the jump table. |
|
| |
|
bclrl #2,%d0 |
|
bclrl #2,%d1 |
|
|
|
lslb #2,%d1 |
|
orb %d0,%d1 |d1{3:2} = dtag, d1{1:0} = stag |
|
| ;Tag values: |
|
| ;00 = norm or denorm |
|
| ;01 = zero |
|
| ;10 = inf |
|
| ;11 = nan |
|
lea pmodt,%a1 |
|
movel (%a1,%d1.w*4),%a1 |
|
jmp (%a1) |
|
|
|
smod_snan: |
|
bra src_nan |
|
smod_dnan: |
|
bra dst_nan |
|
smod_oper: |
|
bra t_operr |
|
smod_zro: |
|
moveb ETEMP(%a6),%d1 |get sign of src op |
|
moveb FPTEMP(%a6),%d0 |get sign of dst op |
|
eorb %d0,%d1 |get exor of sign bits |
|
btstl #7,%d1 |test for sign |
|
beqs smod_zsn |if clr, do not set sign big |
|
bsetb #q_sn_bit,FPSR_QBYTE(%a6) |set q-byte sign bit |
|
smod_zsn: |
|
btstl #7,%d0 |test if + or - |
|
beq ld_pzero |if pos then load +0 |
|
bra ld_mzero |else neg load -0 |
|
|
|
smod_fpn: |
|
moveb ETEMP(%a6),%d1 |get sign of src op |
|
moveb FPTEMP(%a6),%d0 |get sign of dst op |
|
eorb %d0,%d1 |get exor of sign bits |
|
btstl #7,%d1 |test for sign |
|
beqs smod_fsn |if clr, do not set sign big |
|
bsetb #q_sn_bit,FPSR_QBYTE(%a6) |set q-byte sign bit |
|
smod_fsn: |
|
tstb DTAG(%a6) |filter out denormal destination case |
|
bpls smod_nrm | |
|
leal FPTEMP(%a6),%a0 |a0<- addr(FPTEMP) |
|
bra t_resdnrm |force UNFL(but exact) result |
|
smod_nrm: |
|
fmovel USER_FPCR(%a6),%fpcr |use user's rmode and precision |
|
fmovex FPTEMP(%a6),%fp0 |return dest to fp0 |
|
rts |
|
|
|
| |
|
| FREM |
|
| |
|
premt: |
|
| ;$25 frem |
|
| ;dtag,stag |
|
.long srem | 00,00 norm,norm = normal |
|
.long srem_oper | 00,01 norm,zero = nan with operr |
|
.long srem_fpn | 00,10 norm,inf = fpn |
|
.long srem_snan | 00,11 norm,nan = nan |
|
.long srem_zro | 01,00 zero,norm = +-zero |
|
.long srem_oper | 01,01 zero,zero = nan with operr |
|
.long srem_zro | 01,10 zero,inf = +-zero |
|
.long srem_snan | 01,11 zero,nan = nan |
|
.long srem_oper | 10,00 inf,norm = nan with operr |
|
.long srem_oper | 10,01 inf,zero = nan with operr |
|
.long srem_oper | 10,10 inf,inf = nan with operr |
|
.long srem_snan | 10,11 inf,nan = nan |
|
.long srem_dnan | 11,00 nan,norm = nan |
|
.long srem_dnan | 11,01 nan,zero = nan |
|
.long srem_dnan | 11,10 nan,inf = nan |
|
.long srem_dnan | 11,11 nan,nan = nan |
|
|
|
.global prem |
|
prem: |
|
clrb FPSR_QBYTE(%a6) |clear quotient field |
|
bfextu STAG(%a6){#0:#3},%d0 |stag = d0 |
|
bfextu DTAG(%a6){#0:#3},%d1 |dtag = d1 |
|
| |
|
| Alias extended denorms to norms for the jump table. |
|
| |
|
bclr #2,%d0 |
|
bclr #2,%d1 |
|
|
|
lslb #2,%d1 |
|
orb %d0,%d1 |d1{3:2} = dtag, d1{1:0} = stag |
|
| ;Tag values: |
|
| ;00 = norm or denorm |
|
| ;01 = zero |
|
| ;10 = inf |
|
| ;11 = nan |
|
lea premt,%a1 |
|
movel (%a1,%d1.w*4),%a1 |
|
jmp (%a1) |
|
|
|
srem_snan: |
|
bra src_nan |
|
srem_dnan: |
|
bra dst_nan |
|
srem_oper: |
|
bra t_operr |
|
srem_zro: |
|
moveb ETEMP(%a6),%d1 |get sign of src op |
|
moveb FPTEMP(%a6),%d0 |get sign of dst op |
|
eorb %d0,%d1 |get exor of sign bits |
|
btstl #7,%d1 |test for sign |
|
beqs srem_zsn |if clr, do not set sign big |
|
bsetb #q_sn_bit,FPSR_QBYTE(%a6) |set q-byte sign bit |
|
srem_zsn: |
|
btstl #7,%d0 |test if + or - |
|
beq ld_pzero |if pos then load +0 |
|
bra ld_mzero |else neg load -0 |
|
|
|
srem_fpn: |
|
moveb ETEMP(%a6),%d1 |get sign of src op |
|
moveb FPTEMP(%a6),%d0 |get sign of dst op |
|
eorb %d0,%d1 |get exor of sign bits |
|
btstl #7,%d1 |test for sign |
|
beqs srem_fsn |if clr, do not set sign big |
|
bsetb #q_sn_bit,FPSR_QBYTE(%a6) |set q-byte sign bit |
|
srem_fsn: |
|
tstb DTAG(%a6) |filter out denormal destination case |
|
bpls srem_nrm | |
|
leal FPTEMP(%a6),%a0 |a0<- addr(FPTEMP) |
|
bra t_resdnrm |force UNFL(but exact) result |
|
srem_nrm: |
|
fmovel USER_FPCR(%a6),%fpcr |use user's rmode and precision |
|
fmovex FPTEMP(%a6),%fp0 |return dest to fp0 |
|
rts |
|
| |
|
| FSCALE |
|
| |
|
pscalet: |
|
| ;$26 fscale |
|
| ;dtag,stag |
|
.long sscale | 00,00 norm,norm = result |
|
.long sscale | 00,01 norm,zero = fpn |
|
.long scl_opr | 00,10 norm,inf = nan with operr |
|
.long scl_snan | 00,11 norm,nan = nan |
|
.long scl_zro | 01,00 zero,norm = +-zero |
|
.long scl_zro | 01,01 zero,zero = +-zero |
|
.long scl_opr | 01,10 zero,inf = nan with operr |
|
.long scl_snan | 01,11 zero,nan = nan |
|
.long scl_inf | 10,00 inf,norm = +-inf |
|
.long scl_inf | 10,01 inf,zero = +-inf |
|
.long scl_opr | 10,10 inf,inf = nan with operr |
|
.long scl_snan | 10,11 inf,nan = nan |
|
.long scl_dnan | 11,00 nan,norm = nan |
|
.long scl_dnan | 11,01 nan,zero = nan |
|
.long scl_dnan | 11,10 nan,inf = nan |
|
.long scl_dnan | 11,11 nan,nan = nan |
|
|
|
.global pscale |
|
pscale: |
|
bfextu STAG(%a6){#0:#3},%d0 |stag in d0 |
|
bfextu DTAG(%a6){#0:#3},%d1 |dtag in d1 |
|
bclrl #2,%d0 |alias denorm into norm |
|
bclrl #2,%d1 |alias denorm into norm |
|
lslb #2,%d1 |
|
orb %d0,%d1 |d1{4:2} = dtag, d1{1:0} = stag |
|
| ;dtag values stag values: |
|
| ;000 = norm 00 = norm |
|
| ;001 = zero 01 = zero |
|
| ;010 = inf 10 = inf |
|
| ;011 = nan 11 = nan |
|
| ;100 = dnrm |
|
| |
|
| |
|
leal pscalet,%a1 |load start of jump table |
|
movel (%a1,%d1.w*4),%a1 |load a1 with label depending on tag |
|
jmp (%a1) |go to the routine |
|
|
|
scl_opr: |
|
bra t_operr |
|
|
|
scl_dnan: |
|
bra dst_nan |
|
|
|
scl_zro: |
|
btstb #sign_bit,FPTEMP_EX(%a6) |test if + or - |
|
beq ld_pzero |if pos then load +0 |
|
bra ld_mzero |if neg then load -0 |
|
scl_inf: |
|
btstb #sign_bit,FPTEMP_EX(%a6) |test if + or - |
|
beq ld_pinf |if pos then load +inf |
|
bra ld_minf |else neg load -inf |
|
scl_snan: |
|
bra src_nan |
|
| |
|
| FSINCOS |
|
| |
|
.global ssincosz |
|
ssincosz: |
|
btstb #sign_bit,ETEMP(%a6) |get sign |
|
beqs sincosp |
|
fmovex MZERO,%fp0 |
|
bras sincoscom |
|
sincosp: |
|
fmovex PZERO,%fp0 |
|
sincoscom: |
|
fmovemx PONE,%fp1-%fp1 |do not allow FPSR to be affected |
|
bra sto_cos |store cosine result |
|
|
|
.global ssincosi |
|
ssincosi: |
|
fmovex QNAN,%fp1 |load NAN |
|
bsr sto_cos |store cosine result |
|
fmovex QNAN,%fp0 |load NAN |
|
bra t_operr |
|
|
|
.global ssincosnan |
|
ssincosnan: |
|
movel ETEMP_EX(%a6),FP_SCR1(%a6) |
|
movel ETEMP_HI(%a6),FP_SCR1+4(%a6) |
|
movel ETEMP_LO(%a6),FP_SCR1+8(%a6) |
|
bsetb #signan_bit,FP_SCR1+4(%a6) |
|
fmovemx FP_SCR1(%a6),%fp1-%fp1 |
|
bsr sto_cos |
|
bra src_nan |
|
| |
|
| This code forces default values for the zero, inf, and nan cases |
|
| in the transcendentals code. The CC bits must be set in the |
|
| stacked FPSR to be correctly reported. |
|
| |
|
|**Returns +PI/2 |
|
.global ld_ppi2 |
|
ld_ppi2: |
|
fmovex PPIBY2,%fp0 |load +pi/2 |
|
bra t_inx2 |set inex2 exc |
|
|
|
|**Returns -PI/2 |
|
.global ld_mpi2 |
|
ld_mpi2: |
|
fmovex MPIBY2,%fp0 |load -pi/2 |
|
orl #neg_mask,USER_FPSR(%a6) |set N bit |
|
bra t_inx2 |set inex2 exc |
|
|
|
|**Returns +inf |
|
.global ld_pinf |
|
ld_pinf: |
|
fmovex PINF,%fp0 |load +inf |
|
orl #inf_mask,USER_FPSR(%a6) |set I bit |
|
rts |
|
|
|
|**Returns -inf |
|
.global ld_minf |
|
ld_minf: |
|
fmovex MINF,%fp0 |load -inf |
|
orl #neg_mask+inf_mask,USER_FPSR(%a6) |set N and I bits |
|
rts |
|
|
|
|**Returns +1 |
|
.global ld_pone |
|
ld_pone: |
|
fmovex PONE,%fp0 |load +1 |
|
rts |
|
|
|
|**Returns -1 |
|
.global ld_mone |
|
ld_mone: |
|
fmovex MONE,%fp0 |load -1 |
|
orl #neg_mask,USER_FPSR(%a6) |set N bit |
|
rts |
|
|
|
|**Returns +0 |
|
.global ld_pzero |
|
ld_pzero: |
|
fmovex PZERO,%fp0 |load +0 |
|
orl #z_mask,USER_FPSR(%a6) |set Z bit |
|
rts |
|
|
|
|**Returns -0 |
|
.global ld_mzero |
|
ld_mzero: |
|
fmovex MZERO,%fp0 |load -0 |
|
orl #neg_mask+z_mask,USER_FPSR(%a6) |set N and Z bits |
|
rts |
|
|
|
|end
|
|
|