===================================================================
RCS file: /home/cvs/OpenXM_contrib2/asir2000/builtin/math.c,v
retrieving revision 1.7
retrieving revision 1.11
diff -u -p -r1.7 -r1.11
--- OpenXM_contrib2/asir2000/builtin/math.c	2003/12/24 08:00:38	1.7
+++ OpenXM_contrib2/asir2000/builtin/math.c	2015/08/06 10:01:52	1.11
@@ -45,14 +45,17 @@
  * DEVELOPER SHALL HAVE NO LIABILITY IN CONNECTION WITH THE USE,
  * PERFORMANCE OR NON-PERFORMANCE OF THE SOFTWARE.
  *
- * $OpenXM: OpenXM_contrib2/asir2000/builtin/math.c,v 1.6 2003/12/11 00:19:24 noro Exp $ 
+ * $OpenXM: OpenXM_contrib2/asir2000/builtin/math.c,v 1.10 2011/12/15 16:53:26 ohara Exp $ 
 */
 #include "ca.h"
 #include <math.h>
 #include "parse.h"
+#if defined(VISUAL) || defined(__MINGW32__) || defined(__MINGW64__)
+#include <float.h>
+#endif
 
 void Pdsqrt(),Pdsin(),Pdcos(),Pdtan(),Pdasin(),Pdacos(),Pdatan(),Pdlog(),Pdexp();
-void Pabs(),Pdfloor(),Pdceil(),Pdrint();
+void Pabs(),Pdfloor(),Pdceil(),Pdrint(),Pdisnan();
 
 struct ftab math_tab[] = {
 	{"dsqrt",Pdsqrt,1},
@@ -71,27 +74,81 @@ struct ftab math_tab[] = {
 	{"dceil",Pdceil,1},
 	{"rint",Pdrint,1},
 	{"drint",Pdrint,1},
+	{"disnan",Pdisnan,1},
 	{0,0,0},
 };
 
+void get_ri(Num z,double *r,double *i)
+{
+	if ( !z ) {
+		*r = 0; *i = 0; return;
+	}
+	if ( OID(z) != O_N )
+		error("get_ri : invalid argument");
+	switch ( NID(z) ) {
+		case N_Q: case N_R: case N_B:
+			*r = ToReal(z); *i = 0;
+			break;
+		case N_C:
+			*r = ToReal(((C)z)->r);
+			*i = ToReal(((C)z)->i);
+			break;
+		default:
+			error("get_ri : invalid argument");
+			break;
+	}
+}
+
 void Pabs(arg,rp)
 NODE arg;
 Real *rp;
 {
-	double s;
+	double s,r,i;
 
-	s = fabs(ToReal(ARG0(arg)));
+	if ( !ARG0(arg) ) {
+		*rp = 0; return;
+	}
+	get_ri((Num)ARG0(arg),&r,&i);
+	if ( i == 0 )
+		s = fabs(r);
+	else if ( r == 0 )
+		s = fabs(i);
+	else
+		s = sqrt(r*r+i*i);
 	MKReal(s,*rp);
 }
 
 void Pdsqrt(arg,rp)
 NODE arg;
-Real *rp;
+Num *rp;
 {
-	double s;
+	double s,r,i,a;
+	C z;
+	Real real;
 
-	s = sqrt(ToReal(ARG0(arg)));
-	MKReal(s,*rp);
+	if ( !ARG0(arg) ) {
+		*rp = 0; return;
+	}
+	get_ri((Num)ARG0(arg),&r,&i);
+	if ( i == 0 )
+		if ( r > 0 ) {
+			s = sqrt(r);
+			MKReal(s,real);
+			*rp = (Num)real;
+		} else {
+			NEWC(z);
+			z->r = 0;
+			s = sqrt(-r); MKReal(s,real); z->i = (Num)real;
+			*rp = (Num)z;
+		}
+	else {
+		a = sqrt(r*r+i*i);
+		NEWC(z);
+		s = sqrt((r+a)/2); MKReal(s,real); z->r = (Num)real;
+		s = i>0?sqrt((-r+a)/2):-sqrt((-r+a)/2);
+		MKReal(s,real); z->i = (Num)real;
+		*rp = (Num)z;
+	}
 }
 
 void Pdsin(arg,rp)
@@ -201,7 +258,7 @@ Q *rp;
 		a = -a;
 	} else
 		sgn = 1;
-#if defined(i386) || defined(__alpha) || defined(VISUAL) || defined(__x86_64)
+#if defined(i386) || defined(__alpha) || defined(VISUAL) || defined(__MINGW32__) || defined(__MINGW64__) || defined(__x86_64)
 	au = ((unsigned int *)&a)[1];
 	al = ((unsigned int *)&a)[0];
 #else
@@ -244,7 +301,7 @@ Q *rp;
 		a = -a;
 	} else
 		sgn = 1;
-#if defined(i386) || defined(__alpha) || defined(VISUAL) || defined(__x86_64)
+#if defined(i386) || defined(__alpha) || defined(VISUAL) || defined(__MINGW32__) || defined(__MINGW64__) || defined(__x86_64)
 	au = ((unsigned int *)&a)[1];
 	al = ((unsigned int *)&a)[0];
 #else
@@ -274,7 +331,7 @@ Q *rp;
 		*rp = 0;
 		return;
 	}
-#if defined(VISUAL)
+#if defined(VISUAL) || defined(__MINGW32__) || defined(__MINGW64__)
 	d = ToReal(ARG0(arg));
 	if ( d > 0 )
 		d = floor(d+0.5);
@@ -291,7 +348,7 @@ Q *rp;
 		a = -a;
 	} else
 		sgn = 1;
-#if defined(i386) || defined(__alpha) || defined(VISUAL) || defined(__x86_64)
+#if defined(i386) || defined(__alpha) || defined(VISUAL) || defined(__MINGW32__) || defined(__MINGW64__) || defined(__x86_64)
 	au = ((unsigned int *)&a)[1];
 	al = ((unsigned int *)&a)[0];
 #else
@@ -306,4 +363,29 @@ Q *rp;
 	} else
 		q = 0;
 	*rp = q;
+}
+
+void Pdisnan(NODE arg,Q *rp)
+{
+	Real r;
+	double d;
+#if defined(VISUAL) || defined(__MINGW32__) || defined(__MINGW64__)
+    int c;
+#endif
+
+	r = (Real)ARG0(arg);
+	if ( !r || !NUM(r) || !REAL(r) ) {
+		*rp = 0;
+		return;
+	}
+	d = ToReal(r);
+#if defined(VISUAL) || defined(__MINGW32__) || defined(__MINGW64__)
+	c = _fpclass(d);
+	if ( c == _FPCLASS_SNAN || c == _FPCLASS_QNAN ) *rp = ONE;
+	else if ( c == _FPCLASS_PINF || c == _FPCLASS_NINF ) STOQ(2,*rp);
+#else
+	if ( isnan(d) ) *rp = ONE;
+	else if ( isinf(d) ) STOQ(2,*rp);
+#endif
+	else *rp = 0;
 }