; ; File: GetOp.a ; ; Contains: FPU Emulation Package routines to handle Unsupported format/data types ; ; Originally Written by: Motorola Inc. ; Adapted to Apple/MPW: Jon Okada ; ; Copyright: © 1990, 1991 by Apple Computer, Inc., all rights reserved. ; ; This file is used in these builds: Mac32 ; ; Change History (most recent first): ; ; <4> 5/24/91 BG Further streamlined "mk_norm" to treat opclass 0 and opclass 3 ; cases the same. ; <3> 4/13/91 BG Fixed a bug which caused incorrect exception flags and results ; for unnormalized extended input with denormal values. ; <2> 3/30/91 BG Rolling in Jon Okada's latest changes. ; <1> 12/14/90 BG First checked into TERROR/BBS. ; getop.a ; Based upon Motorola file 'get_op.sa'. ; CHANGE LOG: ; 04 Jan 91 JPO Moved constant tables for FMOVECR operation to ; file 'constants.a'. Renamed labels "opclass3" ; and "not_fmovecr" to "gopclass3" and "gnot_fmovecr", ; respectively. ; 13 Mar 91 JPO Refined test for packed decimal SRC for unsupported ; data/format exception (opclass 2). ; 11 Apr 91 JPO Cleaned up subroutine "mk_norm" to properly handle ; unnormalized input with subnormal (denormal) values ; for both unimplemented instruction and unsupported ; format exception handlers. Note that tag masks are ; byte-wide. ; 17 Apr 91 JPO Further streamlined "mk_norm" to treat opclass 0 and ; opclass 3 cases the same. ; * * get_op.sa 3.1 12/10/90 * * 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 unnormormalized 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_executess 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 get_op: clr.b DY_MO_FLG(a6) tst.b UFLG_TMP(a6) ;test flag for unsupp/unimp state beq.b uni_getop uns_getop: btst.b #direction_bit,CMDREG1B(a6) bne.w gopclass3 ;branch if a fmove out (any kind) - label RENAMED <1/4/91, JPO> btst.b #6,CMDREG1B(a6) ; opclass 2 (memory to reg)? <3/13/91, JPO> beq.b @1 ; no. opclass 0 (reg to reg) <3/13/91, JPO> bfextu CMDREG1B(a6){3:3},d0 cmp.b #3,d0 beq.w pack_source ;check for a packed src op, branch if so @1: ; label ADDED <3/13/91, JPO> bsr chk_dy_mo ;set the dyadic/monadic flag tst.b DY_MO_FLG(a6) beq.b src_op_ck ;if monadic, go check src op * ;else, check dst op (fall through) btst.b #7,DTAG(a6) beq.b src_op_ck ;if dst op is norm, check src op bra.b dst_ex_dnrm ;else, handle destination unnorm/dnrm uni_getop: bfextu CMDREG1B(a6){0:6},d0 ;get opclass and src fields cmpi.l #$17,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.b gnot_fmovecr ;handle fmovecr as an unimplemented inst - label RENAMED <1/4/91, JPO> rts gnot_fmovecr: ; label RENAMED <1/4/91, JPO> btst.b #E1,E_BYTE(a6) ;if set, there is a packed operand bne.w pack_source ;check for packed src op, branch if so * The following lines of are coded to optimize on normalized operands move.b STAG(a6),d0 or.b DTAG(a6),d0 ;check if either of STAG/DTAG msb set bmi.b dest_op_ck ;if so, some op needs to be fixed rts dest_op_ck: btst.b #7,DTAG(a6) ;check for unsupported data types in beq.b src_op_ck ;the destination, if not, check src op bsr chk_dy_mo ;set dyadic/monadic flag tst.b DY_MO_FLG(a6) ; beq.b src_op_ck ;if monadic, check src op * * At this point, destination has an extended denorm or unnorm. * dst_ex_dnrm: move.w FPTEMP_EX(a6),d0 ;get destination exponent andi.w #$7fff,d0 ;mask sign, check if exp = 0000 beq.b 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 lea.l 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 * move.b L_SCR1(a6),DTAG(a6) ;write the new tag & fpte15 * ;to the fsave stack and fall * ;through to check source operand * src_op_ck: btst.b #7,STAG(a6) beq.w end_getop ;check for unsupported data types on the * ;source operand btst.b #5,STAG(a6) bne.b src_sd_dnrm ;if bit 5 set, handle sgl/dbl denorms * * At this point only unnorms or extended denorms are possible. * src_ex_dnrm: move.w ETEMP_EX(a6),d0 ;get source exponent andi.w #$7fff,d0 ;mask sign, check if exp = 0000 beq.w end_getop ;if denorm then exit, denorms are * ;handled in do_func lea.l 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 * move.b 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: btst.b #4,CMDREG1B(a6) ;differentiate between sgl/dbl denorm bne.b is_double is_single: move.w #$3f81,d1 ;write bias for sgl denorm bra.b common ;goto the common code is_double: move.w #$3c01,d1 ;write the bias for a dbl denorm common: btst.b #sign_bit,ETEMP_EX(a6) ;grab sign bit of mantissa beq.b pos bset #15,d1 ;set sign bit because it is negative pos: move.w d1,ETEMP_EX(a6) * ;put exponent on stack move.w CMDREG1B(a6),d1 and.w #$e3ff,d1 ;clear out source specifier or.w #$0800,d1 ;set source specifier to extended prec move.w d1,CMDREG1B(a6) ;write back to the command word in stack * ;this is needed to fix unsupp data stack lea.l ETEMP(a6),a0 ;point a0 to sop bsr mk_norm ;convert sgl/dbl denorm to norm move.b 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: move.l FPTEMP_LO(a6),ETEMP(a6) ;write ms part of packed * ;number to etemp slot bsr.b chk_dy_mo ;set dyadic/monadic flag bsr unpack tst.b DY_MO_FLG(a6) beq.b end_getop ;if monadic, exit * ;else, fix FPTEMP pack_dya: bfextu CMDREG1B(a6){6:3},d0 ;extract dest fp reg move.l #7,d1 sub.l d0,d1 clr.l d0 bset.l d1,d0 ;set up d0 as a dynamic register mask fmovem.x d0,FPTEMP(a6) ;write to FPTEMP btst.b #7,DTAG(a6) ;check dest tag for unnorm or denorm bne.w dst_ex_dnrm ;else, handle the unnorm or ext denorm * * Dest is not denormalized. Check for norm, and set fpte15 * accordingly. * move.b DTAG(a6),d0 andi.b #$f0,d0 ;strip to only dtag:fpte15 tst.b d0 ;check for normalized value bne.b end_getop ;if inf/nan/zero leave get_op move.w FPTEMP_EX(a6),d0 andi.w #$7fff,d0 cmpi.w #$3fff,d0 ;check if fpte15 needs setting bge.b end_getop ;if >= $3fff, leave fpte15=0 or.b #$10,DTAG(a6) bra.b end_getop * * At this point, it is either an fmoveout packed, unnorm or denorm * gopclass3: ; label renamed <1/4/91, JPO> clr.b DY_MO_FLG(a6) ;set dyadic/monadic flag to monadic bfextu CMDREG1B(a6){4:2},d0 cmpi.b #3,d0 bne.w 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 * unuspported data type exception. Set if dyadic. * chk_dy_mo: move.w CMDREG1B(a6),d0 btst.l #5,d0 ;testing extension command word beq.b set_mon ;if bit 5 = 0 then monadic btst.l #4,d0 ;know that bit 5 = 1 beq.b set_dya ;if bit 4 = 0 then dyadic andi.w #$007f,d0 ;get rid of all but extension bits {6:0} cmpi.w #$0038,d0 ;if extension = $38 then fcmp (dyadic) bne.b set_mon set_dya: st.b DY_MO_FLG(a6) ;set the inst flag type to dyadic rts set_mon: clr.b DY_MO_FLG(a6) ;set the inst flag type to monadic rts * * MK_NORM - MODIFIED <4/17/91, JPO> * * Normalizes unnormalized numbers, sets tag to norm or denorm * * mk_norm till msb set or exp = 0 * if integer bit = 0 * tag = denorm * 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: clr.l L_SCR1(a6) bclr.b #sign_bit,LOCAL_EX(a0) sne LOCAL_SGN(a0) ;transform into internal extended format ; cmpi.b #$2c,1+EXC_VEC(a6) ;check if unimp - DELETED <4/17/91, JPO> thru next ; bne.b uns_data ;branch if unsupp - DELETED <4/17/91, JPO> ; bsr.b uni_inst ;call if unimp (opclass 0x0) - DELETED <4/17/91, JPO> ; bra.b reload ; DELETED <4/11/91, JPO> ; beq.b uni_inst ; unimplemented <4/11/91, JPO> - DELETED <4/17/91, JPO> ;uns_data: ; label DELETED - <4/11/91, JPO> ; btst.b #direction_bit,CMDREG1B(a6) ;check transfer direction - DELETED <4/17/91, JPO> ; bne.b bit_set ;branch if set (opclass 011) - DELETED <4/11/91, JPO> ; bsr.b uns_opx ;call if opclass 0x0 - DELETED <4/11/91, JPO> ; bra.b reload ; DELETED <4/11/91, JPO> ; ; bne.b uns_op3 ; opclass 011 <4/11/91, JPO> - DELETED <4/17/91, JPO> ;bit_set: ; label DELETED <4/11/91, JPO> ; bsr.b uns_op3 ;opclass 011 - DELETED <4/11/91, JPO> ; ; CASE opclass 0 unsupported or unimplemented - MOVED inline from below <4/11/91, JPO> ; ;uni_inst: ; label DELETED <4/17/91, JPO> bsr nrm_zero ; <4/11/91, JPO> btst.b #7,LOCAL_HI(a0) ;check if integer bit (j-bit) is set ; beq.b uns_den ;if clear then now have a denorm - DELETED <4/11/91, JPO> bne.b reload ;if set, now have a norm <4/11/91, JPO> ; or.w #norm_tag,L_SCR1(a6) ;set tag to norm - DELETED <4/11/91, JPO> ; rts ; DELETED <4/11/91, JPO> ;uns_den: ; label DELETED <4/11/91, JPO> ; or.w #dnrm_tag,L_SCR1(a6) ;set tag to norm - DELETED <4/11/91, JPO> or.b #dnrm_tag,L_SCR1(a6) ; set byte tag to denorm <4/11/91, JPO> reload: cmp.w #$3fff,LOCAL_EX(a0) ;if exp > $3fff bgt.b end_mk ; fpte15/ete15 already set to 0 bset.b #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} beq.b end_mk_pos bset.b #sign_bit,LOCAL_EX(a0) ;convert back to IEEE format end_mk_pos: rts ;* ;* CASE opclass 011 unsupp - modified from subroutine to inline <4/11/91, JPO> thru next ;* then DELETED <4/17/91 JPO> ;uns_op3: ; bsr nrm_zero ;normalize till msb = 1 or exp = zero ; btst.b #7,LOCAL_HI(a0) ;if msb = 1 ; bne.b no_unfl ;then branch ;set_unfl: ; or.w #dnrm_tag,L_SCR1(a6) ;set denorm tag - DELETED <4/11/91, JPO> ; or.b #dnrm_tag,L_SCR1(a6) ; set denorm in byte tag <4/11/91, JPO> ; bset.b #unfl_bit,FPSR_EXCEPT(a6) ;set unfl exception bit no_unfl: ; rts ; DELETED <4/11/91, JPO> ; bra.b reload ; finish up mk_norm <4/11/91, JPO> * * CASE opclass 0x0 unsupp - routine DELETED <4/11/91, JPO> * ;uns_opx: ; bsr nrm_zero ;normalize the number ; or.w #norm_tag,L_SCR1(a6) ;set tag to norm ; rts * * CASE opclass 0x0 unimp - routine MOVED inline above <4/11/91, JPO> * ;uni_inst: ; bsr nrm_zero ; btst.b #7,LOCAL_HI(a0) ;check if integer bit (j-bit) is set ; beq.b uns_den ;if clear then now have a denorm ;uns_nrm: ; or.w #norm_tag,L_SCR1(a6) ;set tag to norm ; rts ;uns_den: ; or.w #dnrm_tag,L_SCR1(a6) ;set tag to norm ; 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: move.w CMDREG1B(a6),d0 ;examine command word, looking for fmove's and.w #$3b,d0 beq move_unpack ;special handling for fmove: must set FPSR_CC move.w ETEMP(a6),d0 ;get word with inf information bfextu d0{20:12},d1 ;get exponent into d1 cmpi.w #$0fff,d1 ;test for inf or NaN bne.b try_zero ;if not equal, it is not special bfextu d0{17:3},d1 ;get SE and y bits into d1 cmpi.w #7,d1 ;SE and y bits must be on for special bne.b try_zero ;if not on, it is not special *input is of the special cases of inf and NaN tst.l ETEMP_HI(a6) ;check ms mantissa bne.b fix_nan ;if non-zero, it is a NaN tst.l ETEMP_LO(a6) ;check ls mantissa bne.b fix_nan ;if non-zero, it is a NaN bra.w finish ;special already on stack fix_nan: btst.b #signan_bit,ETEMP_HI(a6) ;test for snan bne.w finish or.l #snaniop_mask,USER_FPSR(a6) ;always set snan if it is so bra.w finish try_zero: move.w ETEMP_EX+2(a6),d0 ;get word 4 andi.w #$000f,d0 ;clear all but last ni(y)bble tst.w d0 ;check for zero. bne.b not_spec tst.l ETEMP_HI(a6) ;check words 3 and 2 bne.b not_spec tst.l ETEMP_LO(a6) ;check words 1 and 0 bne.b not_spec tst.l ETEMP(a6) ;test sign of the zero bge.b pos_zero move.l #$80000000,ETEMP(a6) ;write neg zero to etemp clr.l ETEMP_HI(a6) clr.l ETEMP_LO(a6) bra.w finish pos_zero: clr.l ETEMP(a6) clr.l ETEMP_HI(a6) clr.l ETEMP_LO(a6) bra.w finish not_spec: fmovem.x fp0,-(a7) ;save fp0 - decbin returns in it bsr decbin fmove.x fp0,ETEMP(a6) ;put the unpacked sop in the fsave stack fmovem.x (a7)+,fp0 fmove.l #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: move.w ETEMP(a6),d0 ;get word with inf information bfextu d0{20:12},d1 ;get exponent into d1 cmpi.w #$0fff,d1 ;test for inf or NaN bne.b mtry_zero ;if not equal, it is not special bfextu d0{17:3},d1 ;get SE and y bits into d1 cmpi.w #7,d1 ;SE and y bits must be on for special bne.b mtry_zero ;if not on, it is not special *input is of the special cases of inf and NaN tst.l ETEMP_HI(a6) ;check ms mantissa bne.b mfix_nan ;if non-zero, it is a NaN tst.l ETEMP_LO(a6) ;check ls mantissa bne.b mfix_nan ;if non-zero, it is a NaN *input is inf or.l #inf_mask,USER_FPSR(a6) ;set I bit tst.l ETEMP(a6) ;check sign bge.w finish or.l #neg_mask,USER_FPSR(a6) ;set N bit bra.w finish ;special already on stack mfix_nan: or.l #nan_mask,USER_FPSR(a6) ;set NaN bit move.b #nan_tag,STAG(a6) ;set stag to NaN btst.b #signan_bit,ETEMP_HI(a6) ;test for snan bne.b mn_snan or.l #snaniop_mask,USER_FPSR(a6) ;set snan bit btst.b #snan_bit,FPCR_ENABLE(a6) ;test for snan enabled bne.b mn_snan bset.b #signan_bit,ETEMP_HI(a6) ;force snans to qnans mn_snan: tst.l ETEMP(a6) ;check for sign bge.b finish ;if clr, go on or.l #neg_mask,USER_FPSR(a6) ;set N bit bra.b finish mtry_zero: move.w ETEMP_EX+2(a6),d0 ;get word 4 andi.w #$000f,d0 ;clear all but last ni(y)bble tst.w d0 ;check for zero. bne.b mnot_spec tst.l ETEMP_HI(a6) ;check words 3 and 2 bne.b mnot_spec tst.l ETEMP_LO(a6) ;check words 1 and 0 bne.b mnot_spec tst.l ETEMP(a6) ;test sign of the zero bge.b mpos_zero or.l #neg_mask+z_mask,USER_FPSR(a6) ;set N and Z move.l #$80000000,ETEMP(a6) ;write neg zero to etemp clr.l ETEMP_HI(a6) clr.l ETEMP_LO(a6) bra.b finish mpos_zero: or.l #z_mask,USER_FPSR(a6) ;set Z clr.l ETEMP(a6) clr.l ETEMP_HI(a6) clr.l ETEMP_LO(a6) bra.b finish mnot_spec: fmovem.x fp0,-(a7) ;save fp0 - decbin returns in it bsr decbin fmove.x fp0,ETEMP(a6) * ;put the unpacked sop in the fsave stack fmovem.x (a7)+,fp0 finish: move.w CMDREG1B(a6),d0 ;get the command word and.w #$fbff,d0 ;change the source specifier field to * ;extended (was packed). move.w 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. * move.w ETEMP_EX(a6),d1 andi.w #$7fff,d1 ;strip sign cmp.w #$7fff,d1 bne.b z_or_nrm move.l ETEMP_HI(a6),d1 bne.b is_nan move.l ETEMP_LO(a6),d1 bne.b is_nan is_inf: move.b #$40,STAG(a6) move.l #$40,d0 rts is_nan: move.b #$60,STAG(a6) move.l #$60,d0 rts z_or_nrm: tst.w d1 bne.b is_nrm is_zro: * For a zero, set etemp_15 move.b #$30,STAG(a6) move.l #$20,d0 rts is_nrm: * For a norm, check if the exp <= $3fff; if so, set etemp_15 cmpi.w #$3fff,d1 ble.b set_bit15 move.b #0,STAG(a6) bra.b end_is_nrm set_bit15: move.b #$10,STAG(a6) end_is_nrm: move.l #0,d0 end_fix: rts end_get: rts