version 1.10, 2011/12/15 16:53:26 |
version 1.13, 2018/03/29 01:32:50 |
|
|
* 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.9 2011/08/24 07:20:09 noro Exp $ |
* $OpenXM: OpenXM_contrib2/asir2000/builtin/math.c,v 1.12 2015/08/14 13:51:54 fujimoto Exp $ |
*/ |
*/ |
#include "ca.h" |
#include "ca.h" |
#include <math.h> |
#include <math.h> |
#include "parse.h" |
#include "parse.h" |
#if defined(VISUAL) |
#if defined(VISUAL) || defined(__MINGW32__) |
#include <float.h> |
#include <float.h> |
#endif |
#endif |
|
|
Line 58 void Pdsqrt(),Pdsin(),Pdcos(),Pdtan(),Pdasin(),Pdacos( |
|
Line 58 void Pdsqrt(),Pdsin(),Pdcos(),Pdtan(),Pdasin(),Pdacos( |
|
void Pabs(),Pdfloor(),Pdceil(),Pdrint(),Pdisnan(); |
void Pabs(),Pdfloor(),Pdceil(),Pdrint(),Pdisnan(); |
|
|
struct ftab math_tab[] = { |
struct ftab math_tab[] = { |
{"dsqrt",Pdsqrt,1}, |
{"dsqrt",Pdsqrt,1}, |
{"dabs",Pabs,1}, |
{"dabs",Pabs,1}, |
{"dsin",Pdsin,1}, |
{"dsin",Pdsin,1}, |
{"dcos",Pdcos,1}, |
{"dcos",Pdcos,1}, |
{"dtan",Pdtan,1}, |
{"dtan",Pdtan,1}, |
{"dlog",Pdlog,1}, |
{"dlog",Pdlog,1}, |
{"dexp",Pdexp,1}, |
{"dexp",Pdexp,1}, |
{"dasin",Pdasin,1}, |
{"dasin",Pdasin,1}, |
{"dacos",Pdacos,1}, |
{"dacos",Pdacos,1}, |
{"datan",Pdatan,1}, |
{"datan",Pdatan,1}, |
{"floor",Pdfloor,1}, |
{"floor",Pdfloor,1}, |
{"dfloor",Pdfloor,1}, |
{"dfloor",Pdfloor,1}, |
{"ceil",Pdceil,1}, |
{"ceil",Pdceil,1}, |
{"dceil",Pdceil,1}, |
{"dceil",Pdceil,1}, |
{"rint",Pdrint,1}, |
{"rint",Pdrint,1}, |
{"drint",Pdrint,1}, |
{"drint",Pdrint,1}, |
{"disnan",Pdisnan,1}, |
{"disnan",Pdisnan,1}, |
{0,0,0}, |
{0,0,0}, |
}; |
}; |
|
|
void get_ri(Num z,double *r,double *i) |
void get_ri(Num z,double *r,double *i) |
{ |
{ |
if ( !z ) { |
if ( !z ) { |
*r = 0; *i = 0; return; |
*r = 0; *i = 0; return; |
} |
} |
if ( OID(z) != O_N ) |
if ( OID(z) != O_N ) |
error("get_ri : invalid argument"); |
error("get_ri : invalid argument"); |
switch ( NID(z) ) { |
switch ( NID(z) ) { |
case N_Q: case N_R: case N_B: |
case N_Q: case N_R: case N_B: |
*r = ToReal(z); *i = 0; |
*r = ToReal(z); *i = 0; |
break; |
break; |
case N_C: |
case N_C: |
*r = ToReal(((C)z)->r); |
*r = ToReal(((C)z)->r); |
*i = ToReal(((C)z)->i); |
*i = ToReal(((C)z)->i); |
break; |
break; |
default: |
default: |
error("get_ri : invalid argument"); |
error("get_ri : invalid argument"); |
break; |
break; |
} |
} |
} |
} |
|
|
void Pabs(arg,rp) |
void Pabs(arg,rp) |
NODE arg; |
NODE arg; |
Real *rp; |
Real *rp; |
{ |
{ |
double s,r,i; |
double s,r,i; |
|
|
if ( !ARG0(arg) ) { |
if ( !ARG0(arg) ) { |
*rp = 0; return; |
*rp = 0; return; |
} |
} |
get_ri((Num)ARG0(arg),&r,&i); |
get_ri((Num)ARG0(arg),&r,&i); |
if ( i == 0 ) |
if ( i == 0 ) |
s = fabs(r); |
s = fabs(r); |
else if ( r == 0 ) |
else if ( r == 0 ) |
s = fabs(i); |
s = fabs(i); |
else |
else |
s = sqrt(r*r+i*i); |
s = sqrt(r*r+i*i); |
MKReal(s,*rp); |
MKReal(s,*rp); |
} |
} |
|
|
void Pdsqrt(arg,rp) |
void Pdsqrt(arg,rp) |
NODE arg; |
NODE arg; |
Num *rp; |
Num *rp; |
{ |
{ |
double s,r,i,a; |
double s,r,i,a; |
C z; |
C z; |
Real real; |
Real real; |
|
|
if ( !ARG0(arg) ) { |
if ( !ARG0(arg) ) { |
*rp = 0; return; |
*rp = 0; return; |
} |
} |
get_ri((Num)ARG0(arg),&r,&i); |
get_ri((Num)ARG0(arg),&r,&i); |
if ( i == 0 ) |
if ( i == 0 ) |
if ( r > 0 ) { |
if ( r > 0 ) { |
s = sqrt(r); |
s = sqrt(r); |
MKReal(s,real); |
MKReal(s,real); |
*rp = (Num)real; |
*rp = (Num)real; |
} else { |
} else { |
NEWC(z); |
NEWC(z); |
z->r = 0; |
z->r = 0; |
s = sqrt(-r); MKReal(s,real); z->i = (Num)real; |
s = sqrt(-r); MKReal(s,real); z->i = (Num)real; |
*rp = (Num)z; |
*rp = (Num)z; |
} |
} |
else { |
else { |
a = sqrt(r*r+i*i); |
a = sqrt(r*r+i*i); |
NEWC(z); |
NEWC(z); |
s = sqrt((r+a)/2); MKReal(s,real); z->r = (Num)real; |
s = sqrt((r+a)/2); MKReal(s,real); z->r = (Num)real; |
s = i>0?sqrt((-r+a)/2):-sqrt((-r+a)/2); |
s = i>0?sqrt((-r+a)/2):-sqrt((-r+a)/2); |
MKReal(s,real); z->i = (Num)real; |
MKReal(s,real); z->i = (Num)real; |
*rp = (Num)z; |
*rp = (Num)z; |
} |
} |
} |
} |
|
|
void Pdsin(arg,rp) |
void Pdsin(arg,rp) |
NODE arg; |
NODE arg; |
Real *rp; |
Real *rp; |
{ |
{ |
double s; |
double s; |
|
|
s = sin(ToReal(ARG0(arg))); |
s = sin(ToReal(ARG0(arg))); |
MKReal(s,*rp); |
MKReal(s,*rp); |
} |
} |
|
|
void Pdcos(arg,rp) |
void Pdcos(arg,rp) |
NODE arg; |
NODE arg; |
Real *rp; |
Real *rp; |
{ |
{ |
double s; |
double s; |
|
|
s = cos(ToReal(ARG0(arg))); |
s = cos(ToReal(ARG0(arg))); |
MKReal(s,*rp); |
MKReal(s,*rp); |
} |
} |
|
|
void Pdtan(arg,rp) |
void Pdtan(arg,rp) |
NODE arg; |
NODE arg; |
Real *rp; |
Real *rp; |
{ |
{ |
double s; |
double s; |
|
|
s = tan(ToReal(ARG0(arg))); |
s = tan(ToReal(ARG0(arg))); |
MKReal(s,*rp); |
MKReal(s,*rp); |
} |
} |
|
|
void Pdasin(arg,rp) |
void Pdasin(arg,rp) |
NODE arg; |
NODE arg; |
Real *rp; |
Real *rp; |
{ |
{ |
double s; |
double s; |
|
|
s = asin(ToReal(ARG0(arg))); |
s = asin(ToReal(ARG0(arg))); |
MKReal(s,*rp); |
MKReal(s,*rp); |
} |
} |
|
|
void Pdacos(arg,rp) |
void Pdacos(arg,rp) |
NODE arg; |
NODE arg; |
Real *rp; |
Real *rp; |
{ |
{ |
double s; |
double s; |
|
|
s = acos(ToReal(ARG0(arg))); |
s = acos(ToReal(ARG0(arg))); |
MKReal(s,*rp); |
MKReal(s,*rp); |
} |
} |
|
|
void Pdatan(arg,rp) |
void Pdatan(arg,rp) |
NODE arg; |
NODE arg; |
Real *rp; |
Real *rp; |
{ |
{ |
double s; |
double s; |
|
|
s = atan(ToReal(ARG0(arg))); |
s = atan(ToReal(ARG0(arg))); |
MKReal(s,*rp); |
MKReal(s,*rp); |
} |
} |
|
|
void Pdlog(arg,rp) |
void Pdlog(arg,rp) |
NODE arg; |
NODE arg; |
Real *rp; |
Real *rp; |
{ |
{ |
double s; |
double s; |
|
|
s = log(ToReal(ARG0(arg))); |
s = log(ToReal(ARG0(arg))); |
MKReal(s,*rp); |
MKReal(s,*rp); |
} |
} |
|
|
void Pdexp(arg,rp) |
void Pdexp(arg,rp) |
NODE arg; |
NODE arg; |
Real *rp; |
Real *rp; |
{ |
{ |
double s; |
double s; |
|
|
s = exp(ToReal(ARG0(arg))); |
s = exp(ToReal(ARG0(arg))); |
MKReal(s,*rp); |
MKReal(s,*rp); |
} |
} |
|
|
void Pdfloor(arg,rp) |
void Pdfloor(arg,rp) |
NODE arg; |
NODE arg; |
Q *rp; |
Q *rp; |
{ |
{ |
L a; |
L a; |
unsigned int au,al; |
unsigned int au,al; |
int sgn; |
int sgn; |
Q q; |
Q q; |
double d; |
double d; |
|
|
if ( !ARG0(arg) ) { |
if ( !ARG0(arg) ) { |
*rp = 0; |
*rp = 0; |
return; |
return; |
} |
} |
d = floor(ToReal(ARG0(arg))); |
d = floor(ToReal(ARG0(arg))); |
if ( d < -9.223372036854775808e18 || d >= 9.223372036854775808e18 ) |
if ( d < -9.223372036854775808e18 || d >= 9.223372036854775808e18 ) |
error("dfloor : OverFlow"); |
error("dfloor : OverFlow"); |
if ( !d ) { |
if ( !d ) { |
*rp = 0; |
*rp = 0; |
return; |
return; |
} |
} |
a = (L)d; |
a = (L)d; |
if ( a < 0 ) { |
if ( a < 0 ) { |
sgn = -1; |
sgn = -1; |
a = -a; |
a = -a; |
} else |
} else |
sgn = 1; |
sgn = 1; |
#if defined(i386) || defined(__alpha) || defined(VISUAL) || defined(__x86_64) |
#if defined(i386) || defined(__alpha) || defined(VISUAL) || defined(__MINGW32__) || 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 |
al = ((unsigned int *)&a)[1]; |
al = ((unsigned int *)&a)[1]; |
au = ((unsigned int *)&a)[0]; |
au = ((unsigned int *)&a)[0]; |
#endif |
#endif |
if ( au ) { |
if ( au ) { |
NEWQ(q); SGN(q) = sgn; NM(q)=NALLOC(2); DN(q)=0; |
NEWQ(q); SGN(q) = sgn; NM(q)=NALLOC(2); DN(q)=0; |
PL(NM(q))=2; BD(NM(q))[0]=al; BD(NM(q))[1] = au; |
PL(NM(q))=2; BD(NM(q))[0]=al; BD(NM(q))[1] = au; |
} else { |
} else { |
UTOQ(al,q); SGN(q) = sgn; |
UTOQ(al,q); SGN(q) = sgn; |
} |
} |
*rp = q; |
*rp = q; |
} |
} |
|
|
void Pdceil(arg,rp) |
void Pdceil(arg,rp) |
NODE arg; |
NODE arg; |
Q *rp; |
Q *rp; |
{ |
{ |
L a; |
L a; |
unsigned int au,al; |
unsigned int au,al; |
int sgn; |
int sgn; |
Q q; |
Q q; |
double d; |
double d; |
|
|
if ( !ARG0(arg) ) { |
if ( !ARG0(arg) ) { |
*rp = 0; |
*rp = 0; |
return; |
return; |
} |
} |
d = ceil(ToReal(ARG0(arg))); |
d = ceil(ToReal(ARG0(arg))); |
if ( d < -9.223372036854775808e18 || d >= 9.223372036854775808e18 ) |
if ( d < -9.223372036854775808e18 || d >= 9.223372036854775808e18 ) |
error("dceil : OverFlow"); |
error("dceil : OverFlow"); |
if ( !d ) { |
if ( !d ) { |
*rp = 0; |
*rp = 0; |
return; |
return; |
} |
} |
a = (L)d; |
a = (L)d; |
if ( a < 0 ) { |
if ( a < 0 ) { |
sgn = -1; |
sgn = -1; |
a = -a; |
a = -a; |
} else |
} else |
sgn = 1; |
sgn = 1; |
#if defined(i386) || defined(__alpha) || defined(VISUAL) || defined(__x86_64) |
#if defined(i386) || defined(__alpha) || defined(VISUAL) || defined(__MINGW32__) || 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 |
al = ((unsigned int *)&a)[1]; |
al = ((unsigned int *)&a)[1]; |
au = ((unsigned int *)&a)[0]; |
au = ((unsigned int *)&a)[0]; |
#endif |
#endif |
if ( au ) { |
if ( au ) { |
NEWQ(q); SGN(q) = sgn; NM(q)=NALLOC(2); DN(q)=0; |
NEWQ(q); SGN(q) = sgn; NM(q)=NALLOC(2); DN(q)=0; |
PL(NM(q))=2; BD(NM(q))[0]=al; BD(NM(q))[1] = au; |
PL(NM(q))=2; BD(NM(q))[0]=al; BD(NM(q))[1] = au; |
} else { |
} else { |
UTOQ(al,q); SGN(q) = sgn; |
UTOQ(al,q); SGN(q) = sgn; |
} |
} |
*rp = q; |
*rp = q; |
} |
} |
|
|
void Pdrint(arg,rp) |
void Pdrint(arg,rp) |
NODE arg; |
NODE arg; |
Q *rp; |
Q *rp; |
{ |
{ |
L a; |
L a; |
unsigned int au,al; |
unsigned int au,al; |
int sgn; |
int sgn; |
Q q; |
Q q; |
double d; |
double d; |
|
|
if ( !ARG0(arg) ) { |
if ( !ARG0(arg) ) { |
*rp = 0; |
*rp = 0; |
return; |
return; |
} |
} |
#if defined(VISUAL) |
#if defined(VISUAL) || defined(__MINGW32__) |
d = ToReal(ARG0(arg)); |
d = ToReal(ARG0(arg)); |
if ( d > 0 ) |
if ( d > 0 ) |
d = floor(d+0.5); |
d = floor(d+0.5); |
else |
else |
d = ceil(d-0.5); |
d = ceil(d-0.5); |
#else |
#else |
d = rint(ToReal(ARG0(arg))); |
d = rint(ToReal(ARG0(arg))); |
#endif |
#endif |
if ( d < -9.223372036854775808e18 || d >= 9.223372036854775808e18 ) |
if ( d < -9.223372036854775808e18 || d >= 9.223372036854775808e18 ) |
error("drint : OverFlow"); |
error("drint : OverFlow"); |
a = (L)d; |
a = (L)d; |
if ( a < 0 ) { |
if ( a < 0 ) { |
sgn = -1; |
sgn = -1; |
a = -a; |
a = -a; |
} else |
} else |
sgn = 1; |
sgn = 1; |
#if defined(i386) || defined(__alpha) || defined(VISUAL) || defined(__x86_64) |
#if defined(i386) || defined(__alpha) || defined(VISUAL) || defined(__MINGW32__) || 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 |
al = ((unsigned int *)&a)[1]; |
al = ((unsigned int *)&a)[1]; |
au = ((unsigned int *)&a)[0]; |
au = ((unsigned int *)&a)[0]; |
#endif |
#endif |
if ( au ) { |
if ( au ) { |
NEWQ(q); SGN(q) = sgn; NM(q)=NALLOC(2); DN(q)=0; |
NEWQ(q); SGN(q) = sgn; NM(q)=NALLOC(2); DN(q)=0; |
PL(NM(q))=2; BD(NM(q))[0]=al; BD(NM(q))[1] = au; |
PL(NM(q))=2; BD(NM(q))[0]=al; BD(NM(q))[1] = au; |
} else if ( al ) { |
} else if ( al ) { |
UTOQ(al,q); SGN(q) = sgn; |
UTOQ(al,q); SGN(q) = sgn; |
} else |
} else |
q = 0; |
q = 0; |
*rp = q; |
*rp = q; |
} |
} |
|
|
void Pdisnan(NODE arg,Q *rp) |
void Pdisnan(NODE arg,Q *rp) |
{ |
{ |
Real r; |
Real r; |
double d; |
double d; |
#if defined(VISUAL) |
#if defined(VISUAL) || defined(__MINGW32__) |
int c; |
int c; |
#endif |
#endif |
|
|
r = (Real)ARG0(arg); |
r = (Real)ARG0(arg); |
if ( !r || !NUM(r) || !REAL(r) ) { |
if ( !r || !NUM(r) || !REAL(r) ) { |
*rp = 0; |
*rp = 0; |
return; |
return; |
} |
} |
d = ToReal(r); |
d = ToReal(r); |
#if defined(VISUAL) |
#if defined(VISUAL) || defined(__MINGW32__) |
c = _fpclass(d); |
c = _fpclass(d); |
if ( c == _FPCLASS_SNAN || c == _FPCLASS_QNAN ) *rp = ONE; |
if ( c == _FPCLASS_SNAN || c == _FPCLASS_QNAN ) *rp = ONE; |
else if ( c == _FPCLASS_PINF || c == _FPCLASS_NINF ) STOQ(2,*rp); |
else if ( c == _FPCLASS_PINF || c == _FPCLASS_NINF ) STOQ(2,*rp); |
#else |
#else |
if ( isnan(d) ) *rp = ONE; |
if ( isnan(d) ) *rp = ONE; |
else if ( isinf(d) ) STOQ(2,*rp); |
else if ( isinf(d) ) STOQ(2,*rp); |
#endif |
#endif |
else *rp = 0; |
else *rp = 0; |
} |
} |