mirror of
https://github.com/autc04/Retro68.git
synced 2024-12-11 03:52:59 +00:00
127 lines
3.0 KiB
C
127 lines
3.0 KiB
C
|
/* $NetBSD: cephes_subr.c,v 1.1 2007/08/20 16:01:33 drochner Exp $ */
|
||
|
|
||
|
/*-
|
||
|
* Copyright (c) 2007 The NetBSD Foundation, Inc.
|
||
|
* All rights reserved.
|
||
|
*
|
||
|
* This code is derived from software written by Stephen L. Moshier.
|
||
|
* It is redistributed by the NetBSD Foundation by permission of the author.
|
||
|
*
|
||
|
* Redistribution and use in source and binary forms, with or without
|
||
|
* modification, are permitted provided that the following conditions
|
||
|
* are met:
|
||
|
* 1. Redistributions of source code must retain the above copyright
|
||
|
* notice, this list of conditions and the following disclaimer.
|
||
|
* 2. Redistributions in binary form must reproduce the above copyright
|
||
|
* notice, this list of conditions and the following disclaimer in the
|
||
|
* documentation and/or other materials provided with the distribution.
|
||
|
*
|
||
|
* THIS SOFTWARE IS PROVIDED BY THE NETBSD FOUNDATION, INC. AND CONTRIBUTORS
|
||
|
* ``AS IS'' AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
|
||
|
* TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR
|
||
|
* PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE FOUNDATION OR CONTRIBUTORS
|
||
|
* BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR
|
||
|
* CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF
|
||
|
* SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS
|
||
|
* INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN
|
||
|
* CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
|
||
|
* ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE
|
||
|
* POSSIBILITY OF SUCH DAMAGE.
|
||
|
*
|
||
|
* imported and modified include for newlib 2010/10/03
|
||
|
* Marco Atzeri <marco_atzeri@yahoo.it>
|
||
|
*/
|
||
|
|
||
|
#include <complex.h>
|
||
|
#include <math.h>
|
||
|
#include "cephes_subr.h"
|
||
|
|
||
|
/* calculate cosh and sinh */
|
||
|
|
||
|
void
|
||
|
_cchsh(double x, double *c, double *s)
|
||
|
{
|
||
|
double e, ei;
|
||
|
|
||
|
if (fabs(x) <= 0.5) {
|
||
|
*c = cosh(x);
|
||
|
*s = sinh(x);
|
||
|
} else {
|
||
|
e = exp(x);
|
||
|
ei = 0.5 / e;
|
||
|
e = 0.5 * e;
|
||
|
*s = e - ei;
|
||
|
*c = e + ei;
|
||
|
}
|
||
|
}
|
||
|
|
||
|
/* Program to subtract nearest integer multiple of PI */
|
||
|
|
||
|
/* extended precision value of PI: */
|
||
|
static const double DP1 = 3.14159265160560607910E0;
|
||
|
static const double DP2 = 1.98418714791870343106E-9;
|
||
|
static const double DP3 = 1.14423774522196636802E-17;
|
||
|
#define MACHEP 1.1e-16
|
||
|
|
||
|
double
|
||
|
_redupi(double x)
|
||
|
{
|
||
|
double t;
|
||
|
long i;
|
||
|
|
||
|
t = x / M_PI;
|
||
|
if (t >= 0.0)
|
||
|
t += 0.5;
|
||
|
else
|
||
|
t -= 0.5;
|
||
|
|
||
|
i = t; /* the multiple */
|
||
|
t = i;
|
||
|
t = ((x - t * DP1) - t * DP2) - t * DP3;
|
||
|
return t;
|
||
|
}
|
||
|
|
||
|
/* Taylor series expansion for cosh(2y) - cos(2x) */
|
||
|
|
||
|
double
|
||
|
_ctans(double complex z)
|
||
|
{
|
||
|
double f, x, x2, y, y2, rn, t;
|
||
|
double d;
|
||
|
|
||
|
x = fabs(2.0 * creal(z));
|
||
|
y = fabs(2.0 * cimag(z));
|
||
|
|
||
|
x = _redupi(x);
|
||
|
|
||
|
x = x * x;
|
||
|
y = y * y;
|
||
|
x2 = 1.0;
|
||
|
y2 = 1.0;
|
||
|
f = 1.0;
|
||
|
rn = 0.0;
|
||
|
d = 0.0;
|
||
|
do {
|
||
|
rn += 1.0;
|
||
|
f *= rn;
|
||
|
rn += 1.0;
|
||
|
f *= rn;
|
||
|
x2 *= x;
|
||
|
y2 *= y;
|
||
|
t = y2 + x2;
|
||
|
t /= f;
|
||
|
d += t;
|
||
|
|
||
|
rn += 1.0;
|
||
|
f *= rn;
|
||
|
rn += 1.0;
|
||
|
f *= rn;
|
||
|
x2 *= x;
|
||
|
y2 *= y;
|
||
|
t = y2 - x2;
|
||
|
t /= f;
|
||
|
d += t;
|
||
|
} while (fabs(t/d) > MACHEP);
|
||
|
return d;
|
||
|
}
|