* as/z80/z80mch.c: fixed bug #1704376: missing as-z80 errors

[fw/sdcc] / device / lib / _fs2slong.c

diff --git a/device/lib/_fs2slong.c b/device/lib/_fs2slong.c
index 236ef878789d91600cf3be43e5d70236c4d3680e..961bff9cec9010822615830ece7b3182e7c50643 100644 (file)
--- a/device/lib/_fs2slong.c
+++ b/device/lib/_fs2slong.c
@@ -1,7 +1,102 @@
+/* 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.
+ */
+
+
+#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;
@@ -12,3 +107,5 @@ signed long __fs2slong (float f) {
     return __fs2ulong(f);
   }
 }
+
+#endif