diff options
Diffstat (limited to 'lib/libF77/c_sqrt.c')
-rw-r--r-- | lib/libF77/c_sqrt.c | 34 |
1 files changed, 34 insertions, 0 deletions
diff --git a/lib/libF77/c_sqrt.c b/lib/libF77/c_sqrt.c new file mode 100644 index 0000000..3b7342f --- /dev/null +++ b/lib/libF77/c_sqrt.c @@ -0,0 +1,34 @@ +#include "f2c.h" + +#ifdef KR_headers +extern double sqrt(), f__cabs(); + +VOID c_sqrt(r, z) complex *r, *z; +#else +#undef abs +#include "math.h" +extern double f__cabs(double, double); + +void c_sqrt(complex *r, complex *z) +#endif +{ +double mag, t; + +if( (mag = f__cabs(z->r, z->i)) == 0.) + r->r = r->i = 0.; +else if(z->r > 0) + { + r->r = t = sqrt(0.5 * (mag + z->r) ); + t = z->i / t; + r->i = 0.5 * t; + } +else + { + t = sqrt(0.5 * (mag - z->r) ); + if(z->i < 0) + t = -t; + r->i = t; + t = z->i / t; + r->r = 0.5 * t; + } +} |