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;
 | 
						|
}
 |