| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 1 | | | 
 | 2 | |	get_op.sa 3.6 5/19/92 | 
 | 3 | | | 
 | 4 | |	get_op.sa 3.5 4/26/91 | 
 | 5 | | | 
 | 6 | |  Description: This routine is called by the unsupported format/data | 
 | 7 | | type exception handler ('unsupp' - vector 55) and the unimplemented | 
 | 8 | | instruction exception handler ('unimp' - vector 11).  'get_op' | 
 | 9 | | determines the opclass (0, 2, or 3) and branches to the | 
 | 10 | | opclass handler routine.  See 68881/2 User's Manual table 4-11 | 
 | 11 | | for a description of the opclasses. | 
 | 12 | | | 
 | 13 | | For UNSUPPORTED data/format (exception vector 55) and for | 
 | 14 | | UNIMPLEMENTED instructions (exception vector 11) the following | 
 | 15 | | applies: | 
 | 16 | | | 
 | 17 | | - For unnormalized numbers (opclass 0, 2, or 3) the | 
 | 18 | | number(s) is normalized and the operand type tag is updated. | 
 | 19 | | | 
 | 20 | | - For a packed number (opclass 2) the number is unpacked and the | 
 | 21 | | operand type tag is updated. | 
 | 22 | | | 
 | 23 | | - For denormalized numbers (opclass 0 or 2) the number(s) is not | 
 | 24 | | changed but passed to the next module.  The next module for | 
 | 25 | | unimp is do_func, the next module for unsupp is res_func. | 
 | 26 | | | 
 | 27 | | For UNSUPPORTED data/format (exception vector 55) only the | 
 | 28 | | following applies: | 
 | 29 | | | 
 | 30 | | - If there is a move out with a packed number (opclass 3) the | 
 | 31 | | number is packed and written to user memory.  For the other | 
 | 32 | | opclasses the number(s) are written back to the fsave stack | 
 | 33 | | and the instruction is then restored back into the '040.  The | 
 | 34 | | '040 is then able to complete the instruction. | 
 | 35 | | | 
 | 36 | | For example: | 
 | 37 | | fadd.x fpm,fpn where the fpm contains an unnormalized number. | 
 | 38 | | The '040 takes an unsupported data trap and gets to this | 
 | 39 | | routine.  The number is normalized, put back on the stack and | 
 | 40 | | then an frestore is done to restore the instruction back into | 
 | 41 | | the '040.  The '040 then re-executes the fadd.x fpm,fpn with | 
 | 42 | | a normalized number in the source and the instruction is | 
 | 43 | | successful. | 
 | 44 | | | 
 | 45 | | Next consider if in the process of normalizing the un- | 
 | 46 | | normalized number it becomes a denormalized number.  The | 
 | 47 | | routine which converts the unnorm to a norm (called mk_norm) | 
 | 48 | | detects this and tags the number as a denorm.  The routine | 
 | 49 | | res_func sees the denorm tag and converts the denorm to a | 
 | 50 | | norm.  The instruction is then restored back into the '040 | 
 | 51 | | which re_executes the instruction. | 
 | 52 | | | 
 | 53 | | | 
 | 54 | |		Copyright (C) Motorola, Inc. 1990 | 
 | 55 | |			All Rights Reserved | 
 | 56 | | | 
| Matt Waddel | e00d82d | 2006-02-11 17:55:48 -0800 | [diff] [blame] | 57 | |       For details on the license for this file, please see the | 
 | 58 | |       file, README, in this same directory. | 
| Linus Torvalds | 1da177e | 2005-04-16 15:20:36 -0700 | [diff] [blame] | 59 |  | 
 | 60 | GET_OP:    |idnt    2,1 | Motorola 040 Floating Point Software Package | 
 | 61 |  | 
 | 62 | 	|section	8 | 
 | 63 |  | 
 | 64 | #include "fpsp.h" | 
 | 65 |  | 
 | 66 | 	.global	PIRN,PIRZRM,PIRP | 
 | 67 | 	.global	SMALRN,SMALRZRM,SMALRP | 
 | 68 | 	.global	BIGRN,BIGRZRM,BIGRP | 
 | 69 |  | 
 | 70 | PIRN: | 
 | 71 | 	.long 0x40000000,0xc90fdaa2,0x2168c235    |pi | 
 | 72 | PIRZRM: | 
 | 73 | 	.long 0x40000000,0xc90fdaa2,0x2168c234    |pi | 
 | 74 | PIRP: | 
 | 75 | 	.long 0x40000000,0xc90fdaa2,0x2168c235    |pi | 
 | 76 |  | 
 | 77 | |round to nearest | 
 | 78 | SMALRN: | 
 | 79 | 	.long 0x3ffd0000,0x9a209a84,0xfbcff798    |log10(2) | 
 | 80 | 	.long 0x40000000,0xadf85458,0xa2bb4a9a    |e | 
 | 81 | 	.long 0x3fff0000,0xb8aa3b29,0x5c17f0bc    |log2(e) | 
 | 82 | 	.long 0x3ffd0000,0xde5bd8a9,0x37287195    |log10(e) | 
 | 83 | 	.long 0x00000000,0x00000000,0x00000000    |0.0 | 
 | 84 | | round to zero;round to negative infinity | 
 | 85 | SMALRZRM: | 
 | 86 | 	.long 0x3ffd0000,0x9a209a84,0xfbcff798    |log10(2) | 
 | 87 | 	.long 0x40000000,0xadf85458,0xa2bb4a9a    |e | 
 | 88 | 	.long 0x3fff0000,0xb8aa3b29,0x5c17f0bb    |log2(e) | 
 | 89 | 	.long 0x3ffd0000,0xde5bd8a9,0x37287195    |log10(e) | 
 | 90 | 	.long 0x00000000,0x00000000,0x00000000    |0.0 | 
 | 91 | | round to positive infinity | 
 | 92 | SMALRP: | 
 | 93 | 	.long 0x3ffd0000,0x9a209a84,0xfbcff799    |log10(2) | 
 | 94 | 	.long 0x40000000,0xadf85458,0xa2bb4a9b    |e | 
 | 95 | 	.long 0x3fff0000,0xb8aa3b29,0x5c17f0bc    |log2(e) | 
 | 96 | 	.long 0x3ffd0000,0xde5bd8a9,0x37287195    |log10(e) | 
 | 97 | 	.long 0x00000000,0x00000000,0x00000000    |0.0 | 
 | 98 |  | 
 | 99 | |round to nearest | 
 | 100 | BIGRN: | 
 | 101 | 	.long 0x3ffe0000,0xb17217f7,0xd1cf79ac    |ln(2) | 
 | 102 | 	.long 0x40000000,0x935d8ddd,0xaaa8ac17    |ln(10) | 
 | 103 | 	.long 0x3fff0000,0x80000000,0x00000000    |10 ^ 0 | 
 | 104 |  | 
 | 105 | 	.global	PTENRN | 
 | 106 | PTENRN: | 
 | 107 | 	.long 0x40020000,0xA0000000,0x00000000    |10 ^ 1 | 
 | 108 | 	.long 0x40050000,0xC8000000,0x00000000    |10 ^ 2 | 
 | 109 | 	.long 0x400C0000,0x9C400000,0x00000000    |10 ^ 4 | 
 | 110 | 	.long 0x40190000,0xBEBC2000,0x00000000    |10 ^ 8 | 
 | 111 | 	.long 0x40340000,0x8E1BC9BF,0x04000000    |10 ^ 16 | 
 | 112 | 	.long 0x40690000,0x9DC5ADA8,0x2B70B59E    |10 ^ 32 | 
 | 113 | 	.long 0x40D30000,0xC2781F49,0xFFCFA6D5    |10 ^ 64 | 
 | 114 | 	.long 0x41A80000,0x93BA47C9,0x80E98CE0    |10 ^ 128 | 
 | 115 | 	.long 0x43510000,0xAA7EEBFB,0x9DF9DE8E    |10 ^ 256 | 
 | 116 | 	.long 0x46A30000,0xE319A0AE,0xA60E91C7    |10 ^ 512 | 
 | 117 | 	.long 0x4D480000,0xC9767586,0x81750C17    |10 ^ 1024 | 
 | 118 | 	.long 0x5A920000,0x9E8B3B5D,0xC53D5DE5    |10 ^ 2048 | 
 | 119 | 	.long 0x75250000,0xC4605202,0x8A20979B    |10 ^ 4096 | 
 | 120 | |round to minus infinity | 
 | 121 | BIGRZRM: | 
 | 122 | 	.long 0x3ffe0000,0xb17217f7,0xd1cf79ab    |ln(2) | 
 | 123 | 	.long 0x40000000,0x935d8ddd,0xaaa8ac16    |ln(10) | 
 | 124 | 	.long 0x3fff0000,0x80000000,0x00000000    |10 ^ 0 | 
 | 125 |  | 
 | 126 | 	.global	PTENRM | 
 | 127 | PTENRM: | 
 | 128 | 	.long 0x40020000,0xA0000000,0x00000000    |10 ^ 1 | 
 | 129 | 	.long 0x40050000,0xC8000000,0x00000000    |10 ^ 2 | 
 | 130 | 	.long 0x400C0000,0x9C400000,0x00000000    |10 ^ 4 | 
 | 131 | 	.long 0x40190000,0xBEBC2000,0x00000000    |10 ^ 8 | 
 | 132 | 	.long 0x40340000,0x8E1BC9BF,0x04000000    |10 ^ 16 | 
 | 133 | 	.long 0x40690000,0x9DC5ADA8,0x2B70B59D    |10 ^ 32 | 
 | 134 | 	.long 0x40D30000,0xC2781F49,0xFFCFA6D5    |10 ^ 64 | 
 | 135 | 	.long 0x41A80000,0x93BA47C9,0x80E98CDF    |10 ^ 128 | 
 | 136 | 	.long 0x43510000,0xAA7EEBFB,0x9DF9DE8D    |10 ^ 256 | 
 | 137 | 	.long 0x46A30000,0xE319A0AE,0xA60E91C6    |10 ^ 512 | 
 | 138 | 	.long 0x4D480000,0xC9767586,0x81750C17    |10 ^ 1024 | 
 | 139 | 	.long 0x5A920000,0x9E8B3B5D,0xC53D5DE5    |10 ^ 2048 | 
 | 140 | 	.long 0x75250000,0xC4605202,0x8A20979A    |10 ^ 4096 | 
 | 141 | |round to positive infinity | 
 | 142 | BIGRP: | 
 | 143 | 	.long 0x3ffe0000,0xb17217f7,0xd1cf79ac    |ln(2) | 
 | 144 | 	.long 0x40000000,0x935d8ddd,0xaaa8ac17    |ln(10) | 
 | 145 | 	.long 0x3fff0000,0x80000000,0x00000000    |10 ^ 0 | 
 | 146 |  | 
 | 147 | 	.global	PTENRP | 
 | 148 | PTENRP: | 
 | 149 | 	.long 0x40020000,0xA0000000,0x00000000    |10 ^ 1 | 
 | 150 | 	.long 0x40050000,0xC8000000,0x00000000    |10 ^ 2 | 
 | 151 | 	.long 0x400C0000,0x9C400000,0x00000000    |10 ^ 4 | 
 | 152 | 	.long 0x40190000,0xBEBC2000,0x00000000    |10 ^ 8 | 
 | 153 | 	.long 0x40340000,0x8E1BC9BF,0x04000000    |10 ^ 16 | 
 | 154 | 	.long 0x40690000,0x9DC5ADA8,0x2B70B59E    |10 ^ 32 | 
 | 155 | 	.long 0x40D30000,0xC2781F49,0xFFCFA6D6    |10 ^ 64 | 
 | 156 | 	.long 0x41A80000,0x93BA47C9,0x80E98CE0    |10 ^ 128 | 
 | 157 | 	.long 0x43510000,0xAA7EEBFB,0x9DF9DE8E    |10 ^ 256 | 
 | 158 | 	.long 0x46A30000,0xE319A0AE,0xA60E91C7    |10 ^ 512 | 
 | 159 | 	.long 0x4D480000,0xC9767586,0x81750C18    |10 ^ 1024 | 
 | 160 | 	.long 0x5A920000,0x9E8B3B5D,0xC53D5DE6    |10 ^ 2048 | 
 | 161 | 	.long 0x75250000,0xC4605202,0x8A20979B    |10 ^ 4096 | 
 | 162 |  | 
 | 163 | 	|xref	nrm_zero | 
 | 164 | 	|xref	decbin | 
 | 165 | 	|xref	round | 
 | 166 |  | 
 | 167 | 	.global    get_op | 
 | 168 | 	.global    uns_getop | 
 | 169 | 	.global    uni_getop | 
 | 170 | get_op: | 
 | 171 | 	clrb	DY_MO_FLG(%a6) | 
 | 172 | 	tstb	UFLG_TMP(%a6)	|test flag for unsupp/unimp state | 
 | 173 | 	beq	uni_getop | 
 | 174 |  | 
 | 175 | uns_getop: | 
 | 176 | 	btstb	#direction_bit,CMDREG1B(%a6) | 
 | 177 | 	bne	opclass3	|branch if a fmove out (any kind) | 
 | 178 | 	btstb	#6,CMDREG1B(%a6) | 
 | 179 | 	beqs	uns_notpacked | 
 | 180 |  | 
 | 181 | 	bfextu	CMDREG1B(%a6){#3:#3},%d0 | 
 | 182 | 	cmpb	#3,%d0 | 
 | 183 | 	beq	pack_source	|check for a packed src op, branch if so | 
 | 184 | uns_notpacked: | 
 | 185 | 	bsr	chk_dy_mo	|set the dyadic/monadic flag | 
 | 186 | 	tstb	DY_MO_FLG(%a6) | 
 | 187 | 	beqs	src_op_ck	|if monadic, go check src op | 
 | 188 | |				;else, check dst op (fall through) | 
 | 189 |  | 
 | 190 | 	btstb	#7,DTAG(%a6) | 
 | 191 | 	beqs	src_op_ck	|if dst op is norm, check src op | 
 | 192 | 	bras	dst_ex_dnrm	|else, handle destination unnorm/dnrm | 
 | 193 |  | 
 | 194 | uni_getop: | 
 | 195 | 	bfextu	CMDREG1B(%a6){#0:#6},%d0 |get opclass and src fields | 
 | 196 | 	cmpil	#0x17,%d0		|if op class and size fields are $17, | 
 | 197 | |				;it is FMOVECR; if not, continue | 
 | 198 | | | 
 | 199 | | If the instruction is fmovecr, exit get_op.  It is handled | 
 | 200 | | in do_func and smovecr.sa. | 
 | 201 | | | 
 | 202 | 	bne	not_fmovecr	|handle fmovecr as an unimplemented inst | 
 | 203 | 	rts | 
 | 204 |  | 
 | 205 | not_fmovecr: | 
 | 206 | 	btstb	#E1,E_BYTE(%a6)	|if set, there is a packed operand | 
 | 207 | 	bne	pack_source	|check for packed src op, branch if so | 
 | 208 |  | 
 | 209 | | The following lines of are coded to optimize on normalized operands | 
 | 210 | 	moveb	STAG(%a6),%d0 | 
 | 211 | 	orb	DTAG(%a6),%d0	|check if either of STAG/DTAG msb set | 
 | 212 | 	bmis	dest_op_ck	|if so, some op needs to be fixed | 
 | 213 | 	rts | 
 | 214 |  | 
 | 215 | dest_op_ck: | 
 | 216 | 	btstb	#7,DTAG(%a6)	|check for unsupported data types in | 
 | 217 | 	beqs	src_op_ck	|the destination, if not, check src op | 
 | 218 | 	bsr	chk_dy_mo	|set dyadic/monadic flag | 
 | 219 | 	tstb	DY_MO_FLG(%a6)	| | 
 | 220 | 	beqs	src_op_ck	|if monadic, check src op | 
 | 221 | | | 
 | 222 | | At this point, destination has an extended denorm or unnorm. | 
 | 223 | | | 
 | 224 | dst_ex_dnrm: | 
 | 225 | 	movew	FPTEMP_EX(%a6),%d0 |get destination exponent | 
 | 226 | 	andiw	#0x7fff,%d0	|mask sign, check if exp = 0000 | 
 | 227 | 	beqs	src_op_ck	|if denorm then check source op. | 
 | 228 | |				;denorms are taken care of in res_func | 
 | 229 | |				;(unsupp) or do_func (unimp) | 
 | 230 | |				;else unnorm fall through | 
 | 231 | 	leal	FPTEMP(%a6),%a0	|point a0 to dop - used in mk_norm | 
 | 232 | 	bsr	mk_norm		|go normalize - mk_norm returns: | 
 | 233 | |				;L_SCR1{7:5} = operand tag | 
 | 234 | |				;	(000 = norm, 100 = denorm) | 
 | 235 | |				;L_SCR1{4} = fpte15 or ete15 | 
 | 236 | |				;	0 = exp >  $3fff | 
 | 237 | |				;	1 = exp <= $3fff | 
 | 238 | |				;and puts the normalized num back | 
 | 239 | |				;on the fsave stack | 
 | 240 | | | 
 | 241 | 	moveb L_SCR1(%a6),DTAG(%a6) |write the new tag & fpte15 | 
 | 242 | |				;to the fsave stack and fall | 
 | 243 | |				;through to check source operand | 
 | 244 | | | 
 | 245 | src_op_ck: | 
 | 246 | 	btstb	#7,STAG(%a6) | 
 | 247 | 	beq	end_getop	|check for unsupported data types on the | 
 | 248 | |				;source operand | 
 | 249 | 	btstb	#5,STAG(%a6) | 
 | 250 | 	bnes	src_sd_dnrm	|if bit 5 set, handle sgl/dbl denorms | 
 | 251 | | | 
 | 252 | | At this point only unnorms or extended denorms are possible. | 
 | 253 | | | 
 | 254 | src_ex_dnrm: | 
 | 255 | 	movew	ETEMP_EX(%a6),%d0 |get source exponent | 
 | 256 | 	andiw	#0x7fff,%d0	|mask sign, check if exp = 0000 | 
 | 257 | 	beq	end_getop	|if denorm then exit, denorms are | 
 | 258 | |				;handled in do_func | 
 | 259 | 	leal	ETEMP(%a6),%a0	|point a0 to sop - used in mk_norm | 
 | 260 | 	bsr	mk_norm		|go normalize - mk_norm returns: | 
 | 261 | |				;L_SCR1{7:5} = operand tag | 
 | 262 | |				;	(000 = norm, 100 = denorm) | 
 | 263 | |				;L_SCR1{4} = fpte15 or ete15 | 
 | 264 | |				;	0 = exp >  $3fff | 
 | 265 | |				;	1 = exp <= $3fff | 
 | 266 | |				;and puts the normalized num back | 
 | 267 | |				;on the fsave stack | 
 | 268 | | | 
 | 269 | 	moveb	L_SCR1(%a6),STAG(%a6) |write the new tag & ete15 | 
 | 270 | 	rts			|end_getop | 
 | 271 |  | 
 | 272 | | | 
 | 273 | | At this point, only single or double denorms are possible. | 
 | 274 | | If the inst is not fmove, normalize the source.  If it is, | 
 | 275 | | do nothing to the input. | 
 | 276 | | | 
 | 277 | src_sd_dnrm: | 
 | 278 | 	btstb	#4,CMDREG1B(%a6)	|differentiate between sgl/dbl denorm | 
 | 279 | 	bnes	is_double | 
 | 280 | is_single: | 
 | 281 | 	movew	#0x3f81,%d1	|write bias for sgl denorm | 
 | 282 | 	bras	common		|goto the common code | 
 | 283 | is_double: | 
 | 284 | 	movew	#0x3c01,%d1	|write the bias for a dbl denorm | 
 | 285 | common: | 
 | 286 | 	btstb	#sign_bit,ETEMP_EX(%a6) |grab sign bit of mantissa | 
 | 287 | 	beqs	pos | 
 | 288 | 	bset	#15,%d1		|set sign bit because it is negative | 
 | 289 | pos: | 
 | 290 | 	movew	%d1,ETEMP_EX(%a6) | 
 | 291 | |				;put exponent on stack | 
 | 292 |  | 
 | 293 | 	movew	CMDREG1B(%a6),%d1 | 
 | 294 | 	andw	#0xe3ff,%d1	|clear out source specifier | 
 | 295 | 	orw	#0x0800,%d1	|set source specifier to extended prec | 
 | 296 | 	movew	%d1,CMDREG1B(%a6)	|write back to the command word in stack | 
 | 297 | |				;this is needed to fix unsupp data stack | 
 | 298 | 	leal	ETEMP(%a6),%a0	|point a0 to sop | 
 | 299 |  | 
 | 300 | 	bsr	mk_norm		|convert sgl/dbl denorm to norm | 
 | 301 | 	moveb	L_SCR1(%a6),STAG(%a6) |put tag into source tag reg - d0 | 
 | 302 | 	rts			|end_getop | 
 | 303 | | | 
 | 304 | | At this point, the source is definitely packed, whether | 
 | 305 | | instruction is dyadic or monadic is still unknown | 
 | 306 | | | 
 | 307 | pack_source: | 
 | 308 | 	movel	FPTEMP_LO(%a6),ETEMP(%a6)	|write ms part of packed | 
 | 309 | |				;number to etemp slot | 
 | 310 | 	bsr	chk_dy_mo	|set dyadic/monadic flag | 
 | 311 | 	bsr	unpack | 
 | 312 |  | 
 | 313 | 	tstb	DY_MO_FLG(%a6) | 
 | 314 | 	beqs	end_getop	|if monadic, exit | 
 | 315 | |				;else, fix FPTEMP | 
 | 316 | pack_dya: | 
 | 317 | 	bfextu	CMDREG1B(%a6){#6:#3},%d0 |extract dest fp reg | 
 | 318 | 	movel	#7,%d1 | 
 | 319 | 	subl	%d0,%d1 | 
 | 320 | 	clrl	%d0 | 
 | 321 | 	bsetl	%d1,%d0		|set up d0 as a dynamic register mask | 
 | 322 | 	fmovemx %d0,FPTEMP(%a6)	|write to FPTEMP | 
 | 323 |  | 
 | 324 | 	btstb	#7,DTAG(%a6)	|check dest tag for unnorm or denorm | 
 | 325 | 	bne	dst_ex_dnrm	|else, handle the unnorm or ext denorm | 
 | 326 | | | 
 | 327 | | Dest is not denormalized.  Check for norm, and set fpte15 | 
 | 328 | | accordingly. | 
 | 329 | | | 
 | 330 | 	moveb	DTAG(%a6),%d0 | 
 | 331 | 	andib	#0xf0,%d0		|strip to only dtag:fpte15 | 
 | 332 | 	tstb	%d0		|check for normalized value | 
 | 333 | 	bnes	end_getop	|if inf/nan/zero leave get_op | 
 | 334 | 	movew	FPTEMP_EX(%a6),%d0 | 
 | 335 | 	andiw	#0x7fff,%d0 | 
 | 336 | 	cmpiw	#0x3fff,%d0	|check if fpte15 needs setting | 
 | 337 | 	bges	end_getop	|if >= $3fff, leave fpte15=0 | 
 | 338 | 	orb	#0x10,DTAG(%a6) | 
 | 339 | 	bras	end_getop | 
 | 340 |  | 
 | 341 | | | 
 | 342 | | At this point, it is either an fmoveout packed, unnorm or denorm | 
 | 343 | | | 
 | 344 | opclass3: | 
 | 345 | 	clrb	DY_MO_FLG(%a6)	|set dyadic/monadic flag to monadic | 
 | 346 | 	bfextu	CMDREG1B(%a6){#4:#2},%d0 | 
 | 347 | 	cmpib	#3,%d0 | 
 | 348 | 	bne	src_ex_dnrm	|if not equal, must be unnorm or denorm | 
 | 349 | |				;else it is a packed move out | 
 | 350 | |				;exit | 
 | 351 | end_getop: | 
 | 352 | 	rts | 
 | 353 |  | 
 | 354 | | | 
 | 355 | | Sets the DY_MO_FLG correctly. This is used only on if it is an | 
 | 356 | | unsupported data type exception.  Set if dyadic. | 
 | 357 | | | 
 | 358 | chk_dy_mo: | 
 | 359 | 	movew	CMDREG1B(%a6),%d0 | 
 | 360 | 	btstl	#5,%d0		|testing extension command word | 
 | 361 | 	beqs	set_mon		|if bit 5 = 0 then monadic | 
 | 362 | 	btstl	#4,%d0		|know that bit 5 = 1 | 
 | 363 | 	beqs	set_dya		|if bit 4 = 0 then dyadic | 
 | 364 | 	andiw	#0x007f,%d0	|get rid of all but extension bits {6:0} | 
 | 365 | 	cmpiw	#0x0038,%d0	|if extension = $38 then fcmp (dyadic) | 
 | 366 | 	bnes	set_mon | 
 | 367 | set_dya: | 
 | 368 | 	st	DY_MO_FLG(%a6)	|set the inst flag type to dyadic | 
 | 369 | 	rts | 
 | 370 | set_mon: | 
 | 371 | 	clrb	DY_MO_FLG(%a6)	|set the inst flag type to monadic | 
 | 372 | 	rts | 
 | 373 | | | 
 | 374 | |	MK_NORM | 
 | 375 | | | 
 | 376 | | Normalizes unnormalized numbers, sets tag to norm or denorm, sets unfl | 
 | 377 | | exception if denorm. | 
 | 378 | | | 
 | 379 | | CASE opclass 0x0 unsupp | 
 | 380 | |	mk_norm till msb set | 
 | 381 | |	set tag = norm | 
 | 382 | | | 
 | 383 | | CASE opclass 0x0 unimp | 
 | 384 | |	mk_norm till msb set or exp = 0 | 
 | 385 | |	if integer bit = 0 | 
 | 386 | |	   tag = denorm | 
 | 387 | |	else | 
 | 388 | |	   tag = norm | 
 | 389 | | | 
 | 390 | | CASE opclass 011 unsupp | 
 | 391 | |	mk_norm till msb set or exp = 0 | 
 | 392 | |	if integer bit = 0 | 
 | 393 | |	   tag = denorm | 
 | 394 | |	   set unfl_nmcexe = 1 | 
 | 395 | |	else | 
 | 396 | |	   tag = norm | 
 | 397 | | | 
 | 398 | | if exp <= $3fff | 
 | 399 | |   set ete15 or fpte15 = 1 | 
 | 400 | | else set ete15 or fpte15 = 0 | 
 | 401 |  | 
 | 402 | | input: | 
 | 403 | |	a0 = points to operand to be normalized | 
 | 404 | | output: | 
 | 405 | |	L_SCR1{7:5} = operand tag (000 = norm, 100 = denorm) | 
 | 406 | |	L_SCR1{4}   = fpte15 or ete15 (0 = exp > $3fff, 1 = exp <=$3fff) | 
 | 407 | |	the normalized operand is placed back on the fsave stack | 
 | 408 | mk_norm: | 
 | 409 | 	clrl	L_SCR1(%a6) | 
 | 410 | 	bclrb	#sign_bit,LOCAL_EX(%a0) | 
 | 411 | 	sne	LOCAL_SGN(%a0)	|transform into internal extended format | 
 | 412 |  | 
 | 413 | 	cmpib	#0x2c,1+EXC_VEC(%a6) |check if unimp | 
 | 414 | 	bnes	uns_data	|branch if unsupp | 
 | 415 | 	bsr	uni_inst	|call if unimp (opclass 0x0) | 
 | 416 | 	bras	reload | 
 | 417 | uns_data: | 
 | 418 | 	btstb	#direction_bit,CMDREG1B(%a6) |check transfer direction | 
 | 419 | 	bnes	bit_set		|branch if set (opclass 011) | 
 | 420 | 	bsr	uns_opx		|call if opclass 0x0 | 
 | 421 | 	bras	reload | 
 | 422 | bit_set: | 
 | 423 | 	bsr	uns_op3		|opclass 011 | 
 | 424 | reload: | 
 | 425 | 	cmpw	#0x3fff,LOCAL_EX(%a0) |if exp > $3fff | 
 | 426 | 	bgts	end_mk		|   fpte15/ete15 already set to 0 | 
 | 427 | 	bsetb	#4,L_SCR1(%a6)	|else set fpte15/ete15 to 1 | 
 | 428 | |				;calling routine actually sets the | 
 | 429 | |				;value on the stack (along with the | 
 | 430 | |				;tag), since this routine doesn't | 
 | 431 | |				;know if it should set ete15 or fpte15 | 
 | 432 | |				;ie, it doesn't know if this is the | 
 | 433 | |				;src op or dest op. | 
 | 434 | end_mk: | 
 | 435 | 	bfclr	LOCAL_SGN(%a0){#0:#8} | 
 | 436 | 	beqs	end_mk_pos | 
 | 437 | 	bsetb	#sign_bit,LOCAL_EX(%a0) |convert back to IEEE format | 
 | 438 | end_mk_pos: | 
 | 439 | 	rts | 
 | 440 | | | 
 | 441 | |     CASE opclass 011 unsupp | 
 | 442 | | | 
 | 443 | uns_op3: | 
 | 444 | 	bsr	nrm_zero	|normalize till msb = 1 or exp = zero | 
 | 445 | 	btstb	#7,LOCAL_HI(%a0)	|if msb = 1 | 
 | 446 | 	bnes	no_unfl		|then branch | 
 | 447 | set_unfl: | 
 | 448 | 	orw	#dnrm_tag,L_SCR1(%a6) |set denorm tag | 
 | 449 | 	bsetb	#unfl_bit,FPSR_EXCEPT(%a6) |set unfl exception bit | 
 | 450 | no_unfl: | 
 | 451 | 	rts | 
 | 452 | | | 
 | 453 | |     CASE opclass 0x0 unsupp | 
 | 454 | | | 
 | 455 | uns_opx: | 
 | 456 | 	bsr	nrm_zero	|normalize the number | 
 | 457 | 	btstb	#7,LOCAL_HI(%a0)	|check if integer bit (j-bit) is set | 
 | 458 | 	beqs	uns_den		|if clear then now have a denorm | 
 | 459 | uns_nrm: | 
 | 460 | 	orb	#norm_tag,L_SCR1(%a6) |set tag to norm | 
 | 461 | 	rts | 
 | 462 | uns_den: | 
 | 463 | 	orb	#dnrm_tag,L_SCR1(%a6) |set tag to denorm | 
 | 464 | 	rts | 
 | 465 | | | 
 | 466 | |     CASE opclass 0x0 unimp | 
 | 467 | | | 
 | 468 | uni_inst: | 
 | 469 | 	bsr	nrm_zero | 
 | 470 | 	btstb	#7,LOCAL_HI(%a0)	|check if integer bit (j-bit) is set | 
 | 471 | 	beqs	uni_den		|if clear then now have a denorm | 
 | 472 | uni_nrm: | 
 | 473 | 	orb	#norm_tag,L_SCR1(%a6) |set tag to norm | 
 | 474 | 	rts | 
 | 475 | uni_den: | 
 | 476 | 	orb	#dnrm_tag,L_SCR1(%a6) |set tag to denorm | 
 | 477 | 	rts | 
 | 478 |  | 
 | 479 | | | 
 | 480 | |	Decimal to binary conversion | 
 | 481 | | | 
 | 482 | | Special cases of inf and NaNs are completed outside of decbin. | 
 | 483 | | If the input is an snan, the snan bit is not set. | 
 | 484 | | | 
 | 485 | | input: | 
 | 486 | |	ETEMP(a6)	- points to packed decimal string in memory | 
 | 487 | | output: | 
 | 488 | |	fp0	- contains packed string converted to extended precision | 
 | 489 | |	ETEMP	- same as fp0 | 
 | 490 | unpack: | 
 | 491 | 	movew	CMDREG1B(%a6),%d0	|examine command word, looking for fmove's | 
 | 492 | 	andw	#0x3b,%d0 | 
 | 493 | 	beq	move_unpack	|special handling for fmove: must set FPSR_CC | 
 | 494 |  | 
 | 495 | 	movew	ETEMP(%a6),%d0	|get word with inf information | 
 | 496 | 	bfextu	%d0{#20:#12},%d1	|get exponent into d1 | 
 | 497 | 	cmpiw	#0x0fff,%d1	|test for inf or NaN | 
 | 498 | 	bnes	try_zero	|if not equal, it is not special | 
 | 499 | 	bfextu	%d0{#17:#3},%d1	|get SE and y bits into d1 | 
 | 500 | 	cmpiw	#7,%d1		|SE and y bits must be on for special | 
 | 501 | 	bnes	try_zero	|if not on, it is not special | 
 | 502 | |input is of the special cases of inf and NaN | 
 | 503 | 	tstl	ETEMP_HI(%a6)	|check ms mantissa | 
 | 504 | 	bnes	fix_nan		|if non-zero, it is a NaN | 
 | 505 | 	tstl	ETEMP_LO(%a6)	|check ls mantissa | 
 | 506 | 	bnes	fix_nan		|if non-zero, it is a NaN | 
 | 507 | 	bra	finish		|special already on stack | 
 | 508 | fix_nan: | 
 | 509 | 	btstb	#signan_bit,ETEMP_HI(%a6) |test for snan | 
 | 510 | 	bne	finish | 
 | 511 | 	orl	#snaniop_mask,USER_FPSR(%a6) |always set snan if it is so | 
 | 512 | 	bra	finish | 
 | 513 | try_zero: | 
 | 514 | 	movew	ETEMP_EX+2(%a6),%d0 |get word 4 | 
 | 515 | 	andiw	#0x000f,%d0	|clear all but last ni(y)bble | 
 | 516 | 	tstw	%d0		|check for zero. | 
 | 517 | 	bne	not_spec | 
 | 518 | 	tstl	ETEMP_HI(%a6)	|check words 3 and 2 | 
 | 519 | 	bne	not_spec | 
 | 520 | 	tstl	ETEMP_LO(%a6)	|check words 1 and 0 | 
 | 521 | 	bne	not_spec | 
 | 522 | 	tstl	ETEMP(%a6)	|test sign of the zero | 
 | 523 | 	bges	pos_zero | 
 | 524 | 	movel	#0x80000000,ETEMP(%a6) |write neg zero to etemp | 
 | 525 | 	clrl	ETEMP_HI(%a6) | 
 | 526 | 	clrl	ETEMP_LO(%a6) | 
 | 527 | 	bra	finish | 
 | 528 | pos_zero: | 
 | 529 | 	clrl	ETEMP(%a6) | 
 | 530 | 	clrl	ETEMP_HI(%a6) | 
 | 531 | 	clrl	ETEMP_LO(%a6) | 
 | 532 | 	bra	finish | 
 | 533 |  | 
 | 534 | not_spec: | 
 | 535 | 	fmovemx %fp0-%fp1,-(%a7)	|save fp0 - decbin returns in it | 
 | 536 | 	bsr	decbin | 
 | 537 | 	fmovex %fp0,ETEMP(%a6)	|put the unpacked sop in the fsave stack | 
 | 538 | 	fmovemx (%a7)+,%fp0-%fp1 | 
 | 539 | 	fmovel	#0,%FPSR		|clr fpsr from decbin | 
 | 540 | 	bra	finish | 
 | 541 |  | 
 | 542 | | | 
 | 543 | | Special handling for packed move in:  Same results as all other | 
 | 544 | | packed cases, but we must set the FPSR condition codes properly. | 
 | 545 | | | 
 | 546 | move_unpack: | 
 | 547 | 	movew	ETEMP(%a6),%d0	|get word with inf information | 
 | 548 | 	bfextu	%d0{#20:#12},%d1	|get exponent into d1 | 
 | 549 | 	cmpiw	#0x0fff,%d1	|test for inf or NaN | 
 | 550 | 	bnes	mtry_zero	|if not equal, it is not special | 
 | 551 | 	bfextu	%d0{#17:#3},%d1	|get SE and y bits into d1 | 
 | 552 | 	cmpiw	#7,%d1		|SE and y bits must be on for special | 
 | 553 | 	bnes	mtry_zero	|if not on, it is not special | 
 | 554 | |input is of the special cases of inf and NaN | 
 | 555 | 	tstl	ETEMP_HI(%a6)	|check ms mantissa | 
 | 556 | 	bnes	mfix_nan		|if non-zero, it is a NaN | 
 | 557 | 	tstl	ETEMP_LO(%a6)	|check ls mantissa | 
 | 558 | 	bnes	mfix_nan		|if non-zero, it is a NaN | 
 | 559 | |input is inf | 
 | 560 | 	orl	#inf_mask,USER_FPSR(%a6) |set I bit | 
 | 561 | 	tstl	ETEMP(%a6)	|check sign | 
 | 562 | 	bge	finish | 
 | 563 | 	orl	#neg_mask,USER_FPSR(%a6) |set N bit | 
 | 564 | 	bra	finish		|special already on stack | 
 | 565 | mfix_nan: | 
 | 566 | 	orl	#nan_mask,USER_FPSR(%a6) |set NaN bit | 
 | 567 | 	moveb	#nan_tag,STAG(%a6)	|set stag to NaN | 
 | 568 | 	btstb	#signan_bit,ETEMP_HI(%a6) |test for snan | 
 | 569 | 	bnes	mn_snan | 
 | 570 | 	orl	#snaniop_mask,USER_FPSR(%a6) |set snan bit | 
 | 571 | 	btstb	#snan_bit,FPCR_ENABLE(%a6) |test for snan enabled | 
 | 572 | 	bnes	mn_snan | 
 | 573 | 	bsetb	#signan_bit,ETEMP_HI(%a6) |force snans to qnans | 
 | 574 | mn_snan: | 
 | 575 | 	tstl	ETEMP(%a6)	|check for sign | 
 | 576 | 	bge	finish		|if clr, go on | 
 | 577 | 	orl	#neg_mask,USER_FPSR(%a6) |set N bit | 
 | 578 | 	bra	finish | 
 | 579 |  | 
 | 580 | mtry_zero: | 
 | 581 | 	movew	ETEMP_EX+2(%a6),%d0 |get word 4 | 
 | 582 | 	andiw	#0x000f,%d0	|clear all but last ni(y)bble | 
 | 583 | 	tstw	%d0		|check for zero. | 
 | 584 | 	bnes	mnot_spec | 
 | 585 | 	tstl	ETEMP_HI(%a6)	|check words 3 and 2 | 
 | 586 | 	bnes	mnot_spec | 
 | 587 | 	tstl	ETEMP_LO(%a6)	|check words 1 and 0 | 
 | 588 | 	bnes	mnot_spec | 
 | 589 | 	tstl	ETEMP(%a6)	|test sign of the zero | 
 | 590 | 	bges	mpos_zero | 
 | 591 | 	orl	#neg_mask+z_mask,USER_FPSR(%a6) |set N and Z | 
 | 592 | 	movel	#0x80000000,ETEMP(%a6) |write neg zero to etemp | 
 | 593 | 	clrl	ETEMP_HI(%a6) | 
 | 594 | 	clrl	ETEMP_LO(%a6) | 
 | 595 | 	bras	finish | 
 | 596 | mpos_zero: | 
 | 597 | 	orl	#z_mask,USER_FPSR(%a6) |set Z | 
 | 598 | 	clrl	ETEMP(%a6) | 
 | 599 | 	clrl	ETEMP_HI(%a6) | 
 | 600 | 	clrl	ETEMP_LO(%a6) | 
 | 601 | 	bras	finish | 
 | 602 |  | 
 | 603 | mnot_spec: | 
 | 604 | 	fmovemx %fp0-%fp1,-(%a7)	|save fp0 ,fp1 - decbin returns in fp0 | 
 | 605 | 	bsr	decbin | 
 | 606 | 	fmovex %fp0,ETEMP(%a6) | 
 | 607 | |				;put the unpacked sop in the fsave stack | 
 | 608 | 	fmovemx (%a7)+,%fp0-%fp1 | 
 | 609 |  | 
 | 610 | finish: | 
 | 611 | 	movew	CMDREG1B(%a6),%d0	|get the command word | 
 | 612 | 	andw	#0xfbff,%d0	|change the source specifier field to | 
 | 613 | |				;extended (was packed). | 
 | 614 | 	movew	%d0,CMDREG1B(%a6)	|write command word back to fsave stack | 
 | 615 | |				;we need to do this so the 040 will | 
 | 616 | |				;re-execute the inst. without taking | 
 | 617 | |				;another packed trap. | 
 | 618 |  | 
 | 619 | fix_stag: | 
 | 620 | |Converted result is now in etemp on fsave stack, now set the source | 
 | 621 | |tag (stag) | 
 | 622 | |	if (ete =$7fff) then INF or NAN | 
 | 623 | |		if (etemp = $x.0----0) then | 
 | 624 | |			stag = INF | 
 | 625 | |		else | 
 | 626 | |			stag = NAN | 
 | 627 | |	else | 
 | 628 | |		if (ete = $0000) then | 
 | 629 | |			stag = ZERO | 
 | 630 | |		else | 
 | 631 | |			stag = NORM | 
 | 632 | | | 
 | 633 | | Note also that the etemp_15 bit (just right of the stag) must | 
 | 634 | | be set accordingly. | 
 | 635 | | | 
 | 636 | 	movew		ETEMP_EX(%a6),%d1 | 
 | 637 | 	andiw		#0x7fff,%d1   |strip sign | 
 | 638 | 	cmpw		#0x7fff,%d1 | 
 | 639 | 	bnes		z_or_nrm | 
 | 640 | 	movel		ETEMP_HI(%a6),%d1 | 
 | 641 | 	bnes		is_nan | 
 | 642 | 	movel		ETEMP_LO(%a6),%d1 | 
 | 643 | 	bnes		is_nan | 
 | 644 | is_inf: | 
 | 645 | 	moveb		#0x40,STAG(%a6) | 
 | 646 | 	movel		#0x40,%d0 | 
 | 647 | 	rts | 
 | 648 | is_nan: | 
 | 649 | 	moveb		#0x60,STAG(%a6) | 
 | 650 | 	movel		#0x60,%d0 | 
 | 651 | 	rts | 
 | 652 | z_or_nrm: | 
 | 653 | 	tstw		%d1 | 
 | 654 | 	bnes		is_nrm | 
 | 655 | is_zro: | 
 | 656 | | For a zero, set etemp_15 | 
 | 657 | 	moveb		#0x30,STAG(%a6) | 
 | 658 | 	movel		#0x20,%d0 | 
 | 659 | 	rts | 
 | 660 | is_nrm: | 
 | 661 | | For a norm, check if the exp <= $3fff; if so, set etemp_15 | 
 | 662 | 	cmpiw		#0x3fff,%d1 | 
 | 663 | 	bles		set_bit15 | 
 | 664 | 	moveb		#0,STAG(%a6) | 
 | 665 | 	bras		end_is_nrm | 
 | 666 | set_bit15: | 
 | 667 | 	moveb		#0x10,STAG(%a6) | 
 | 668 | end_is_nrm: | 
 | 669 | 	movel		#0,%d0 | 
 | 670 | end_fix: | 
 | 671 | 	rts | 
 | 672 |  | 
 | 673 | end_get: | 
 | 674 | 	rts | 
 | 675 | 	|end |