version 1.6, 2003/12/11 00:19:24 |
version 1.10, 2011/12/15 16:53:26 |
|
|
* DEVELOPER SHALL HAVE NO LIABILITY IN CONNECTION WITH THE USE, |
* DEVELOPER SHALL HAVE NO LIABILITY IN CONNECTION WITH THE USE, |
* PERFORMANCE OR NON-PERFORMANCE OF THE SOFTWARE. |
* PERFORMANCE OR NON-PERFORMANCE OF THE SOFTWARE. |
* |
* |
* $OpenXM: OpenXM_contrib2/asir2000/builtin/math.c,v 1.5 2003/11/08 01:12:02 noro Exp $ |
* $OpenXM: OpenXM_contrib2/asir2000/builtin/math.c,v 1.9 2011/08/24 07:20:09 noro Exp $ |
*/ |
*/ |
#include "ca.h" |
#include "ca.h" |
#include <math.h> |
#include <math.h> |
#include "parse.h" |
#include "parse.h" |
|
#if defined(VISUAL) |
|
#include <float.h> |
|
#endif |
|
|
void Pdsqrt(),Pdsin(),Pdcos(),Pdtan(),Pdasin(),Pdacos(),Pdatan(),Pdlog(),Pdexp(); |
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[] = { |
struct ftab math_tab[] = { |
{"dsqrt",Pdsqrt,1}, |
{"dsqrt",Pdsqrt,1}, |
Line 71 struct ftab math_tab[] = { |
|
Line 74 struct ftab math_tab[] = { |
|
{"dceil",Pdceil,1}, |
{"dceil",Pdceil,1}, |
{"rint",Pdrint,1}, |
{"rint",Pdrint,1}, |
{"drint",Pdrint,1}, |
{"drint",Pdrint,1}, |
|
{"disnan",Pdisnan,1}, |
{0,0,0}, |
{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) |
void Pabs(arg,rp) |
NODE arg; |
NODE arg; |
Real *rp; |
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); |
MKReal(s,*rp); |
} |
} |
|
|
void Pdsqrt(arg,rp) |
void Pdsqrt(arg,rp) |
NODE arg; |
NODE arg; |
Real *rp; |
Num *rp; |
{ |
{ |
double s; |
double s,r,i,a; |
|
C z; |
|
Real real; |
|
|
s = sqrt(ToReal(ARG0(arg))); |
if ( !ARG0(arg) ) { |
MKReal(s,*rp); |
*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) |
void Pdsin(arg,rp) |
|
|
a = -a; |
a = -a; |
} else |
} else |
sgn = 1; |
sgn = 1; |
#if defined(i386) || defined(__alpha) || defined(VISUAL) |
#if defined(i386) || defined(__alpha) || defined(VISUAL) || defined(__x86_64) |
au = ((unsigned int *)&a)[1]; |
au = ((unsigned int *)&a)[1]; |
al = ((unsigned int *)&a)[0]; |
al = ((unsigned int *)&a)[0]; |
#else |
#else |
|
|
a = -a; |
a = -a; |
} else |
} else |
sgn = 1; |
sgn = 1; |
#if defined(i386) || defined(__alpha) || defined(VISUAL) |
#if defined(i386) || defined(__alpha) || defined(VISUAL) || defined(__x86_64) |
au = ((unsigned int *)&a)[1]; |
au = ((unsigned int *)&a)[1]; |
al = ((unsigned int *)&a)[0]; |
al = ((unsigned int *)&a)[0]; |
#else |
#else |
|
|
a = -a; |
a = -a; |
} else |
} else |
sgn = 1; |
sgn = 1; |
#if defined(i386) || defined(__alpha) || defined(VISUAL) |
#if defined(i386) || defined(__alpha) || defined(VISUAL) || defined(__x86_64) |
au = ((unsigned int *)&a)[1]; |
au = ((unsigned int *)&a)[1]; |
al = ((unsigned int *)&a)[0]; |
al = ((unsigned int *)&a)[0]; |
#else |
#else |
|
|
} else |
} else |
q = 0; |
q = 0; |
*rp = q; |
*rp = q; |
|
} |
|
|
|
void Pdisnan(NODE arg,Q *rp) |
|
{ |
|
Real r; |
|
double d; |
|
#if defined(VISUAL) |
|
int c; |
|
#endif |
|
|
|
r = (Real)ARG0(arg); |
|
if ( !r || !NUM(r) || !REAL(r) ) { |
|
*rp = 0; |
|
return; |
|
} |
|
d = ToReal(r); |
|
#if defined(VISUAL) |
|
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; |
} |
} |