atan2f.c
1.27 KB
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
/*
=============================================================================
Copyright (C) 1997-1999 NINTENDO Co.,Ltd.
$RCSfile: atan2f.c,v $
$Revision: 1.1.1.1 $
$Date: 2002/10/30 02:07:09 $
=============================================================================
関数名：atan2f
-----------------------------------------------------------------------------
書式： #include <math.h>
float atan2f(float y, float x);
引数： x
y
戻り値：引数 ｙ÷引数 ｘのアークタンジェントを返す
説明： 引数 ｙ÷引数 ｘのアークタンジェントを返す
atan(t) = t / (1+(t^2/(3+(2^2*t^2/(5+(3^2*t^2/(7+....)))))))
-----------------------------------------------------------------------------
*/
#include "math.h"
float atan2f(float y, float x)
{
float xx, z;
float a;
int i;
if (x==0 && y==0) return FVAL_ZERO;
if (x==0) {
if (y>0) return FVAL_PI/2;
else return -FVAL_PI/2;
}
xx = y/x;
if (fabsf(xx)<=1) z = xx;
else z = 1/xx;
a = 0;
for (i=14; i>=1; i--) a = i*i*z*z/(1+2*i+a);
z = z/(1+a);
if (xx> 1) z = FVAL_PI/2 - z;
if (xx<-1) z = -FVAL_PI/2 - z;
if (x>0) return z;
else {
if (y>0) return z+FVAL_PI;
else return z-FVAL_PI;
}
}