m68k/math-emu/fp_util.S

12  * 2. Redistributions in binary form must reproduce the above copyright
64 	jmi	1f
66 	jmi	1f
68 	jpl	2f
70 2:	clr.l	%d0
98 	printf	PCONV,"l2e: %p -> %p(",2,%d0,%a0
102 	jpl	1f			| positive?
129 	printf	PCONV,"s2e: %p -> %p(",2,%d0,%a0
240 	jpl	9f			| zero is closer
244 	jeq	9f			| round to zero
247 	jcc	9f
249 	jcc	9f
251 	addq.w	#1,(2,%a0)
257 	subq.w	#2,%d2
258 	jcs	9b			| %d2 < 2, round to zero
259 	jhi	1f			| %d2 > 2, round to +infinity
280 	subq.l	#2,%a0
291 	jcc	1f
315 	jcc	1f
333 	jcc	1f
342 	jcs	1f
368 	jcc	1f
376 	jcs	2f
379 	jcs	1f
387 2:	lsl.l	%d1,%d0
405 	jne	3f
407 	jne	4f
409 2:	subq.l	#8,%a0
419 	jra	2b
464 	jpl	9f			| zero is closer
468 	jeq	9f			| round to zero
471 	jcc	9f
473 	jcc	9f
474 	addq.w	#1,(2,%a0)
481 	subq.w	#2,%d2
482 	jcs	9b			| %d2 < 2, round to zero
483 	jhi	1f			| %d2 > 2, round to +infinity
505 	subq.l	#2,%a0
515 	jcc	1f
540 	jcc	1f
558 	jcc	1f
568 	jcs	1f
594 	jcc	1f
602 	jcs	2f
605 	jcs	1f
613 2:	lsl.l	%d1,%d0
622 	jne	3f
624 	jne	4f
625 2:	subq.l	#8,%a0
633 	jne	4f
638 	jne	2b
641 	jra	2b
647 	| 2:	Round to -Infinity
689 	and.w	#0xf800,(2,%a0)		| clear bits 0-10
691 	jne	2f			| %d2 == 0, round to nearest
711 	jcc	1f			| no overflow, good.
724 2:	subq.w	#2,%d2
725 	jcs	9b			| %d2 < 2, round to zero
726 	jhi	3f			| %d2 > 2, round to +infinity
741 	move.w	#0x3c01,(-2,%a0)	| 2**-1022
744 	jcc	1f
766 	jcc	2f			| No, the number is too small.
775 	jeq	1f
783 2:	clr.l	(%a0)+
790 	jne	1f
792 	jne	1f
799 	| i.e. pathologically small (exponent is 2**-16383) numbers.
806 	move.w	#0x3c01,-(%a0)		| i.e. 2**-1022
814 	jeq	1f
818 	jne	3f			| %d2 = 0 round to nearest
819 1:	move.w	#0x7fff,(-2,%a0)
822 2:	subq.l	#8,%a0
827 3:	subq.w	#2,%d2
828 	jcs	5f			| %d2 < 2, round to zero
829 	jhi	4f			| %d2 > 2, round to +infinity
832 	jra	5f
835 5:	move.w	#0x43fe,(-2,%a0)
840 	jra	2b
857 	addq.l	#2,%a0
869 	jeq	1f
889 	jne	2f			| %d2 == 0, round to nearest
891 	jpl	9f			| zero is closer
896 	jeq	9f			| round to zero
900 	jcc	9f			| no overflow, good.
914 2:	subq.w	#2,%d2
915 	jcs	9b			| %d2 < 2, round to zero
916 	jhi	3f			| %d2 > 2, round to +infinity
927 	move.w	#0x3f81,(-2,%a0)	| 2**-126
930 	jcc	2f
940 	jeq	1f
949 2:	clr.l	(%a0)+
956 	jeq	1f
960 	jne	3f			| %d2 = 0 round to nearest
961 1:	move.w	#0x7fff,(-2,%a0)
964 2:	subq.l	#8,%a0
969 3:	subq.w	#2,%d2
970 	jcs	5f			| %d2 < 2, round to zero
971 	jhi	4f			| %d2 > 2, round to +infinity
974 	jra	5f
977 5:	move.w	#0x407e,(-2,%a0)
980 	jra	2b
984 	jne	1f
986 	jne	1f
993 	| i.e. pathologically small (exponent is 2**-16383) numbers.
1000 	move.w	#0x3f81,-(%a0)		| i.e. 2**-126
1022 	addq.l	#2,%a0
1029 	jeq	1f
1049 	jne	2f			| %d2 == 0, round to nearest
1051 	jpl	9f			| zero is closer
1056 	jeq	9f			| round to zero
1060 	jcc	9f			| no overflow, good.
1074 2:	subq.w	#2,%d2
1075 	jcs	9b			| %d2 < 2, round to zero
1076 	jhi	3f			| %d2 > 2, round to +infinity
1086 	jeq	1f
1090 	jne	3f			| %d2 = 0 round to nearest
1091 1:	move.w	#0x7fff,(-2,%a0)
1094 2:	subq.l	#8,%a0
1099 3:	subq.w	#2,%d2
1100 	jcs	5f			| %d2 < 2, round to zero
1101 	jhi	4f			| %d2 > 2, round to +infinity
1104 	jra	5f
1107 5:	move.w	#0x407e,(-2,%a0)
1110 	jra	2b
1135 	printf	PCONV,"e2i%d: %p(",2,#\b,%a0
1138 	addq.l	#2,%a0
1157 	jne	1f
1163 	jeq	1f
1172 	jeq	5f
1176 	jne	2f			| %d2 == 0, round to nearest
1189 2:	subq.w	#2,%d2
1190 	jcs	9b			| %d2 < 2, round to zero
1191 	jhi	3f			| %d2 > 2, round to +infinity
1198 	| we are only want -2**127 get correctly rounded here,
1203 	jne	2b			| %d2 == 0, round to nearest
1213 	jne	1f
1215 	jeq	3f
1222 	subq.w	#2,%d2
1223 	jcs	3f			| %d2 < 2, round to nearest/zero
1224 	jhi	2f			| %d2 > 2, round to +infinity
1226 	jeq	3f
1228 	jra	3f
1229 2:	tst.w	(-4,%a0)		| to +inf
1230 	jne	3f
1238 	jeq	1f
1245 	jne	1f
1251 	jne	1f
1273 	jne	1f
1276 	jra	2f
1279 	jmi	2f
1281 2:	lsl.w	#5,%d2
1311 	jne	1f
1314 	jra	2f
1317 	jmi	2f
1319 2:	lsl.w	#8,%d1
1356 |	printf	,"f: %p\n",1,%a0
1361 	jne	1f
1363 	jra	2f
1365 2:|	printf	,"f: %p\n",1,%a0
1374 	jeq	1f
1377 	jeq	2f
1381 	jne	9f
1383 	jne	9f
1384 	jra	8f
1386 2:	moveq	#FPSR_CC_NAN-24,%d1
1389 	jne	8f
1391 	jne	8f
1404 	jne	1f
1406 	jeq	2f
1408 2:	btst	#FPSR_EXC_OVFL,%d0	| EXC_OVFL
1409 	jeq	1f
1412 	jeq	1f
1414 	jeq	1f
1417 	jeq	1f
1420 	jne	1f
1422 	jne	1f
1424 	jeq	2f
1426 2:	move.l	%d0,(FPD_FPSR,FPDATA)
1450 	move.b	(FPD_FPSR+2,FPDATA),%d0
1451 	and.b	(FPD_FPCR+2,FPDATA),%d0
1452 	jeq	1f