X-Git-Url: https://git.gag.com/?a=blobdiff_plain;f=device%2Flib%2F_fs2slong.c;h=961bff9cec9010822615830ece7b3182e7c50643;hb=bb226788dab3832b0ec0cda70874ce3fce4eebc6;hp=1c3aec8c8f7d49a2dee2042d9256972010a14819;hpb=07df12abd9fe9f3ff2fa7edb177ff5e38a78324c;p=fw%2Fsdcc

diff --git a/device/lib/_fs2slong.c b/device/lib/_fs2slong.c
index 1c3aec8c..961bff9c 100644
--- a/device/lib/_fs2slong.c
+++ b/device/lib/_fs2slong.c
@@ -1,20 +1,111 @@
-#include <limits.h>
+/* Floating point library in optimized assembly for 8051
+ * Copyright (c) 2004, Paul Stoffregen, paul@pjrc.com
+ *
+ * This program is free software; you can redistribute it and/or
+ * modify it under the terms of the GNU Library General Public License
+ * as published by the Free Software Foundation; either version 2
+ * of the License, or (at your option) any later version.
+ *
+ * This library is distributed in the hope that it will be useful,
+ * but WITHOUT ANY WARRANTY; without even the implied warranty of
+ * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
+ * GNU General Public License for more details.
+ *
+ * You should have received a copy of the GNU General Public License
+ * along with this program; if not, write to the Free Software
+ * Foundation, Inc., 59 Temple Place - Suite 330, Boston, MA  02111-1307, USA.
+ */
 
-unsigned long __fs2ulong (float a1);
+
+#define SDCC_FLOAT_LIB
+#include <float.h>
+
+
+#ifdef FLOAT_ASM_MCS51
+
+// long __fs2slong (float x)
+static void dummy(void) __naked
+{
+	__asm
+	.globl	___fs2slong
+___fs2slong:
+	lcall	fsgetarg
+	clr	c
+	mov	a, #158
+	subb	a, exp_a
+	jc	fs2slong_maxval		//  |x| >= 2^32
+fs2slong_int_ok:
+	mov	r1, #0
+	lcall	fs_rshift_a
+	jnb	sign_a, fs2slong_pos
+fs2slong_neg:
+	mov	a, r1
+	cpl	a
+	add	a, #1
+	mov	dpl, a
+	mov	a, r2
+	cpl	a
+	addc	a, #0
+	mov	dph, a
+	mov	a, r3
+	cpl	a
+	addc	a, #0
+	mov	b, a
+	mov	a, r4
+	cpl	a
+	addc	a, #0
+	//Check for zero
+	jnz fs2slong_not_zero
+	mov a, dpl
+	orl a, dph
+	orl a, b
+	jnz fs2slong_clr_a
+	ret
+fs2slong_clr_a:
+	clr a
+fs2slong_not_zero:
+	jnb acc.7, fs2slong_maxval_neg  // x < -0x80000000
+	ret
+fs2slong_pos:
+	mov	a, r4
+	jb	acc.7, fs2slong_maxval_pos  //  x > 0x7FFFFFFF
+	mov	dpl, r1
+	mov	dph, r2
+	mov	b, r3
+	ret
+fs2slong_maxval:
+	jnb	sign_a, fs2slong_maxval_pos
+fs2slong_maxval_neg:
+	clr	a
+	mov	dpl, a
+	mov	dph, a
+	mov	b, a
+	mov	a, #0x80
+	ret
+fs2slong_maxval_pos:
+	mov	a, #0xFF
+	mov	dpl, a
+	mov	dph, a
+	mov	b, a
+	mov	a, #0x7F
+	ret
+	__endasm;
+}
+
+#else
 
 /* convert float to signed long */
-signed long __fs2slong (float f) {
+signed long __fs2slong (float f)
+{
 
   if (!f)
     return 0;
 
   if (f<0) {
-    if (f<=LONG_MIN)
-      return LONG_MIN;
     return -__fs2ulong(-f);
   } else {
-    if (f>=LONG_MAX)
-      return LONG_MAX;
     return __fs2ulong(f);
   }
 }
+
+#endif