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