117303c62SDavid Schultz
217303c62SDavid Schultz /* FreeBSD: head/lib/msun/src/e_atan2.c 176451 2008-02-22 02:30:36Z das */
317303c62SDavid Schultz /*
417303c62SDavid Schultz * ====================================================
517303c62SDavid Schultz * Copyright (C) 1993 by Sun Microsystems, Inc. All rights reserved.
617303c62SDavid Schultz *
717303c62SDavid Schultz * Developed at SunSoft, a Sun Microsystems, Inc. business.
817303c62SDavid Schultz * Permission to use, copy, modify, and distribute this
917303c62SDavid Schultz * software is freely granted, provided that this notice
1017303c62SDavid Schultz * is preserved.
1117303c62SDavid Schultz * ====================================================
1217303c62SDavid Schultz *
1317303c62SDavid Schultz */
1417303c62SDavid Schultz
1517303c62SDavid Schultz /*
1617303c62SDavid Schultz * See comments in e_atan2.c.
1717303c62SDavid Schultz * Converted to long double by David Schultz <das@FreeBSD.ORG>.
1817303c62SDavid Schultz */
1917303c62SDavid Schultz
2017303c62SDavid Schultz #include <float.h>
2117303c62SDavid Schultz
2217303c62SDavid Schultz #include "invtrig.h"
2317303c62SDavid Schultz #include "math.h"
2417303c62SDavid Schultz #include "math_private.h"
2517303c62SDavid Schultz
2617303c62SDavid Schultz static volatile long double
2717303c62SDavid Schultz tiny = 1.0e-300;
2817303c62SDavid Schultz static const long double
291192a80eSDavid Schultz zero = 0.0;
301192a80eSDavid Schultz
311192a80eSDavid Schultz #ifdef __i386__
321192a80eSDavid Schultz /* XXX Work around the fact that gcc truncates long double constants on i386 */
331192a80eSDavid Schultz static volatile double
341192a80eSDavid Schultz pi1 = 3.14159265358979311600e+00, /* 0x1.921fb54442d18p+1 */
351192a80eSDavid Schultz pi2 = 1.22514845490862001043e-16; /* 0x1.1a80000000000p-53 */
361192a80eSDavid Schultz #define pi ((long double)pi1 + pi2)
371192a80eSDavid Schultz #else
381192a80eSDavid Schultz static const long double
3917303c62SDavid Schultz pi = 3.14159265358979323846264338327950280e+00L;
401192a80eSDavid Schultz #endif
4117303c62SDavid Schultz
4217303c62SDavid Schultz long double
atan2l(long double y,long double x)4317303c62SDavid Schultz atan2l(long double y, long double x)
4417303c62SDavid Schultz {
4517303c62SDavid Schultz union IEEEl2bits ux, uy;
4617303c62SDavid Schultz long double z;
4717303c62SDavid Schultz int32_t k,m;
4817303c62SDavid Schultz int16_t exptx, expsignx, expty, expsigny;
4917303c62SDavid Schultz
5017303c62SDavid Schultz uy.e = y;
5117303c62SDavid Schultz expsigny = uy.xbits.expsign;
5217303c62SDavid Schultz expty = expsigny & 0x7fff;
5317303c62SDavid Schultz ux.e = x;
5417303c62SDavid Schultz expsignx = ux.xbits.expsign;
5517303c62SDavid Schultz exptx = expsignx & 0x7fff;
5617303c62SDavid Schultz
5717303c62SDavid Schultz if ((exptx==BIAS+LDBL_MAX_EXP &&
5817303c62SDavid Schultz ((ux.bits.manh&~LDBL_NBIT)|ux.bits.manl)!=0) || /* x is NaN */
5917303c62SDavid Schultz (expty==BIAS+LDBL_MAX_EXP &&
6017303c62SDavid Schultz ((uy.bits.manh&~LDBL_NBIT)|uy.bits.manl)!=0)) /* y is NaN */
61*6f1b8a07SBruce Evans return nan_mix(x, y);
6217303c62SDavid Schultz if (expsignx==BIAS && ((ux.bits.manh&~LDBL_NBIT)|ux.bits.manl)==0)
6317303c62SDavid Schultz return atanl(y); /* x=1.0 */
6417303c62SDavid Schultz m = ((expsigny>>15)&1)|((expsignx>>14)&2); /* 2*sign(x)+sign(y) */
6517303c62SDavid Schultz
6617303c62SDavid Schultz /* when y = 0 */
6717303c62SDavid Schultz if(expty==0 && ((uy.bits.manh&~LDBL_NBIT)|uy.bits.manl)==0) {
6817303c62SDavid Schultz switch(m) {
6917303c62SDavid Schultz case 0:
7017303c62SDavid Schultz case 1: return y; /* atan(+-0,+anything)=+-0 */
7117303c62SDavid Schultz case 2: return pi+tiny;/* atan(+0,-anything) = pi */
7217303c62SDavid Schultz case 3: return -pi-tiny;/* atan(-0,-anything) =-pi */
7317303c62SDavid Schultz }
7417303c62SDavid Schultz }
7517303c62SDavid Schultz /* when x = 0 */
7617303c62SDavid Schultz if(exptx==0 && ((ux.bits.manh&~LDBL_NBIT)|ux.bits.manl)==0)
7717303c62SDavid Schultz return (expsigny<0)? -pio2_hi-tiny: pio2_hi+tiny;
7817303c62SDavid Schultz
7917303c62SDavid Schultz /* when x is INF */
8017303c62SDavid Schultz if(exptx==BIAS+LDBL_MAX_EXP) {
8117303c62SDavid Schultz if(expty==BIAS+LDBL_MAX_EXP) {
8217303c62SDavid Schultz switch(m) {
8317303c62SDavid Schultz case 0: return pio2_hi*0.5+tiny;/* atan(+INF,+INF) */
8417303c62SDavid Schultz case 1: return -pio2_hi*0.5-tiny;/* atan(-INF,+INF) */
8517303c62SDavid Schultz case 2: return 1.5*pio2_hi+tiny;/*atan(+INF,-INF)*/
8617303c62SDavid Schultz case 3: return -1.5*pio2_hi-tiny;/*atan(-INF,-INF)*/
8717303c62SDavid Schultz }
8817303c62SDavid Schultz } else {
8917303c62SDavid Schultz switch(m) {
9017303c62SDavid Schultz case 0: return zero ; /* atan(+...,+INF) */
9117303c62SDavid Schultz case 1: return -zero ; /* atan(-...,+INF) */
9217303c62SDavid Schultz case 2: return pi+tiny ; /* atan(+...,-INF) */
9317303c62SDavid Schultz case 3: return -pi-tiny ; /* atan(-...,-INF) */
9417303c62SDavid Schultz }
9517303c62SDavid Schultz }
9617303c62SDavid Schultz }
9717303c62SDavid Schultz /* when y is INF */
9817303c62SDavid Schultz if(expty==BIAS+LDBL_MAX_EXP)
9917303c62SDavid Schultz return (expsigny<0)? -pio2_hi-tiny: pio2_hi+tiny;
10017303c62SDavid Schultz
10117303c62SDavid Schultz /* compute y/x */
10217303c62SDavid Schultz k = expty-exptx;
1039d7d0936SDavid Schultz if(k > LDBL_MANT_DIG+2) { /* |y/x| huge */
1049d7d0936SDavid Schultz z=pio2_hi+pio2_lo;
1059d7d0936SDavid Schultz m&=1;
1069d7d0936SDavid Schultz }
10717303c62SDavid Schultz else if(expsignx<0&&k<-LDBL_MANT_DIG-2) z=0.0; /* |y/x| tiny, x<0 */
10817303c62SDavid Schultz else z=atanl(fabsl(y/x)); /* safe to do y/x */
10917303c62SDavid Schultz switch (m) {
11017303c62SDavid Schultz case 0: return z ; /* atan(+,+) */
11117303c62SDavid Schultz case 1: return -z ; /* atan(-,+) */
11217303c62SDavid Schultz case 2: return pi-(z-pi_lo);/* atan(+,-) */
11317303c62SDavid Schultz default: /* case 3 */
11417303c62SDavid Schultz return (z-pi_lo)-pi;/* atan(-,-) */
11517303c62SDavid Schultz }
11617303c62SDavid Schultz }
117