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