sergiotarxz/nuttx
sergiotarxz/nuttx
1
0
Fork 0
Code Issues Pull Requests Releases Wiki Activity

Correct atan2 implementations from Denis Arnst

Browse Source
This commit is contained in:
Gregory Nutt 2014-09-08 07:55:09 -06:00
parent 8f895baa9e
commit 9d03879c8b
3 changed files with 51 additions and 94 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

48
libc/math/lib_atan2.c
View File

@ -41,46 +41,32 @@
#ifdef CONFIG_HAVE_DOUBLE
double atan2(double y, double x)
{
if (y == 0.0)
if (x > 0)
{
if (x >= 0.0)
return atan(y / x);
}
else if (y >= 0 && x < 0)
{
return atan(y / x) + M_PI;
}
else if (y < 0)
{
if (x == 0)
{
return 0.0;
return -M_PI_2;
}
else
else /* Can only be x < 0 */
{
return M_PI;
return atan(y / x) - M_PI;
}
}
else if (y > 0.0)
else if (y > 0 && x == 0)
{
if (x == 0.0)
{
return M_PI_2;
}
else if (x > 0.0)
{
return atan(y / x);
}
else
{
return M_PI - atan(y / x);
}
return M_PI_2;
}
else
else if (y == 0 && x == 0) /* Undefined but returns normally 0 */
{
if (x == 0.0)
{
return M_PI + M_PI_2;
}
else if (x > 0.0)
{
return 2 * M_PI - atan(y / x);
}
else
{
return M_PI + atan(y / x);
}
return 0;
}
}
#endif

48
libc/math/lib_atan2f.c
View File

@ -37,45 +37,31 @@
float atan2f(float y, float x)
{
if (y == 0.0)
if (x > 0)
{
if (x >= 0.0)
return atanf(y / x);
}
else if (y >= 0 && x < 0)
{
return atanf(y / x) + M_PI;
}
else if (y < 0)
{
if (x == 0)
{
return 0.0;
return -M_PI_2;
}
else
else /* Can only be x < 0 */
{
return M_PI;
return atanf(y / x) - M_PI;
}
}
else if (y > 0.0)
else if (y > 0 && x == 0)
{
if (x == 0.0)
{
return M_PI_2;
}
else if (x > 0.0)
{
return atanf(y / x);
}
else
{
return M_PI - atanf(y / x);
}
return M_PI_2;
}
else
else if (y == 0 && x == 0) /* Undefined but returns normally 0 */
{
if (x == 0.0)
{
return M_PI + M_PI_2;
}
else if (x > 0.0)
{
return 2 * M_PI - atanf(y / x);
}
else
{
return M_PI + atanf(y / x);
}
return 0;
}
}

49
libc/math/lib_atan2l.c
View File

@ -41,47 +41,32 @@
#ifdef CONFIG_HAVE_LONG_DOUBLE
long double atan2l(long double y, long double x)
{
if (y == 0.0)
if (x > 0)
{
if (x >= 0.0)
return atanl(y / x);
}
else if (y >= 0 && x < 0)
{
return atanl(y / x) + M_PI;
}
else if (y < 0)
{
if (x == 0)
{
return 0.0;
return -M_PI_2;
}
else
else /* Can only be x < 0 */
{
return M_PI;
return atanl(y / x) - M_PI;
}
}
else if (y > 0.0)
else if (y > 0 && x == 0)
{
if (x == 0.0)
{
return M_PI_2;
}
else if (x > 0.0)
{
return atanl(y / x);
}
else
{
return M_PI - atanl(y / x);
}
return M_PI_2;
}
else
else if (y == 0 && x == 0) /* Undefined but returns normally 0 */
{
if (x == 0.0)
{
return M_PI + M_PI_2;
}
else if (x > 0.0)
{
return 2 * M_PI - atanl(y / x);
}
else
{
return M_PI + atanl(y / x);
}
return 0;
}
}
#endif