3 // Copyright (C) 2000, 2001, Intel Corporation
4 // All rights reserved.
6 // Contributed 6/1/2000 by John Harrison, Ted Kubaska, Bob Norin, Shane Story,
7 // and Ping Tak Peter Tang of the Computational Software Lab, Intel Corporation.
9 // Redistribution and use in source and binary forms, with or without
10 // modification, are permitted provided that the following conditions are
13 // * Redistributions of source code must retain the above copyright
14 // notice, this list of conditions and the following disclaimer.
16 // * Redistributions in binary form must reproduce the above copyright
17 // notice, this list of conditions and the following disclaimer in the
18 // documentation and/or other materials provided with the distribution.
20 // * The name of Intel Corporation may not be used to endorse or promote
21 // products derived from this software without specific prior written
24 // THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
25 // "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
26 // LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR
27 // A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL INTEL OR ITS
28 // CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
29 // EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
30 // PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
31 // PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY
32 // OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY OR TORT (INCLUDING
33 // NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
34 // SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
36 // Intel Corporation is the author of this code, and requests that all
37 // problem reports or change requests be submitted to it directly at
38 // http://developer.intel.com/opensource.
41 //==============================================================
42 // 6/01/00 Initial version
43 // 8/15/00 Bundle added after call to __libm_error_support to properly
44 // set [the previously overwritten] GR_Parameter_RESULT.
45 // 8/17/00 Changed predicate register macro-usage to direct predicate
46 // names due to an assembler bug.
47 // 1/05/01 Fixed flag settings for denormal input.
48 // 1/19/01 Added documentation
49 // 1/30/01 Improved speed
52 //=========================================
53 // The atan2 function computes the principle value of the arc tangent of y/x using
54 // the signs of both arguments to determine the quadrant of the return value.
55 // A domain error may occur if both arguments are zero.
57 // The atan2 function returns the arc tangent of y/x in the range [-pi,+pi] radians.
60 //..Let (v,u) = (y,x) if |y| <= |x|, and (v,u) = (x,y) otherwise. Note that
61 //..v and u can be negative. We state the relationship between atan2(y,x) and
64 //..Let swap = false if v = y, and swap = true if v = x.
65 //..Define C according to the matrix
69 //.. no swap (swap = false) sgn(y)*0 sgn(y)*pi
70 //.. swap (swap = true ) sgn(y)*pi/2 sgn(y)*pi/2
72 //.. atan2(y,x) = C + atan(v/u) if no swap
73 //.. atan2(y,x) = C - atan(v/u) if swap
75 //..These relationship is more efficient to compute as we accommodate signs in v and u
76 //..saving the need to obtain the absolute value before computation can proceed.
78 //..Suppose (v,u) = (y,x), we calculate atan(v/u) as follows:
79 //..A = y * frcpa(x) (so A = (y/x)(1 - beta))
80 //..atan(y/x) = atan(A) + atan( ((y/x)-A))/(1 + (y/x)A) ), the second term is
82 //..atan(A) is approximated by a polynomial
83 //..A + p1 A^3 + p2 A^5 + ... + p10 A^21,
84 //..atan(G) is approximated as follows:
85 //..Let G = (y - Ax)/(x + Ay), atan(G) can be approximated by G + g * p1
86 //..where g is a limited precision approximation to G via g = (y - Ax)*frcpa(x + Ay).
88 //..Suppose (v,u) = (x,y), we calculate atan(v/u) as follows:
89 //..Z = x * frcpa(y) (so Z = (x/y)(1 - beta))
90 //..atan(x/y) = atan(Z) + atan( ((x/y)-Z))/(1 + (x/y)Z) ), the second term is
92 //..atan(Z) is approximated by a polynomial
93 //..Z + p1 Z^3 + p2 Z^5 + ... + p10 Z^21,
94 //..atan(T) is approximated as follows:
95 //..Let T = (x - Ay)/(y + Ax), atan(T) can be approximated by T + t * p1
96 //..where t is a limited precision approximation to T via t = (x - Ay)*frcpa(y + Ax).
100 //..atan(A) ~=~ A + p1 A^3 + ... + P10 A^21
102 //..This polynomial is computed as follows:
103 //..Asq = A*A; Acub = A*Asq, A4 = Asq*Asq
104 //..A5 = Asq*Acub, A6 = Asq*A4; A11 = A5 * A6
106 //..poly_A1 = p9 + Asq*p10, poly_A2 = p7 + Asq*p8, poly_A3 = p5 + Asq*p6
107 //..poly_A1 = poly_A2 + A4 * poly_A1
108 //..poly_A1 = poly_A3 + A4 * poly_A1
111 //,,poly_A5 = p3 + Asq * p4, poly_A4 = A + Asq*poly_A4
112 //..poly_A5 = p2 + Asq * poly_A5
113 //..poly_A4 = poly_A4 + A5 * poly_A5
115 //..atan_A = poly_A4 + A11 * poly_A1
117 //..atan(G) is approximated as follows:
118 //..G_numer = y - A*x, G_denom = x + A*y
119 //..H1 = frcpa(G_denom)
120 //..H_beta = 1 - H1 * G_denom
121 //..H2 = H1 + H1 * H_beta
122 //..H_beta2 = H_beta*H_beta
123 //..H3 = H2 + H2*H_beta2
124 //..g = H1 * G_numer; gsq = g*g; atan_G = g*p1, atan_G = atan_G*gsq
125 //..atan_G = G_numer*H3 + atan_G
129 //..atan(A) ~=~ A + p1 A^3 + ... + P10 A^21
131 //..This polynomial is computed as follows:
132 //..Asq = A*A; Acub = A*Asq, A4 = Asq*Asq
133 //..A5 = Asq*Acub, A6 = Asq*A4; A11 = A5 * A6
135 //..poly_A1 = p9 + Asq*p10, poly_A2 = p7 + Asq*p8, poly_A3 = p5 + Asq*p6
136 //..poly_A1 = poly_A2 + A4 * poly_A1
137 //..poly_A1 = poly_A3 + A4 * poly_A1
140 //,,poly_A5 = p3 + Asq * p4, poly_A4 = A + Asq*poly_A4
141 //..poly_A5 = p2 + Asq * poly_A5
142 //..poly_A4 = poly_A4 + A5 * poly_A5
144 //..atan_A = poly_A4 + A11 * poly_A1
147 //..====================================================================
148 //.. COEFFICIENTS USED IN THE COMPUTATION
149 //..====================================================================
151 //coef_pj, j = 1,2,...,10; atan(A) ~=~ A + p1 A^3 + p2 A^5 + ... + p10 A^21
153 // coef_p1 = -.3333332707155439167401311806315789E+00
154 // coef_p1 in dbl = BFD5 5555 1219 1621
156 // coef_p2 = .1999967670926658391827857030875748E+00
157 // coef_p2 in dbl = 3FC9 997E 7AFB FF4E
159 // coef_p3 = -.1427989384500152360161563301087296E+00
160 // coef_p3 in dbl = BFC2 473C 5145 EE38
162 // coef_p4 = .1105852823460720770079031213661163E+00
163 // coef_p4 in dbl = 3FBC 4F51 2B18 65F5
165 // coef_p5 = -.8811839915595312348625710228448363E-01
166 // coef_p5 in dbl = BFB6 8EED 6A8C FA32
168 // coef_p6 = .6742329836955067042153645159059714E-01
169 // coef_p6 in dbl = 3FB1 42A7 3D7C 54E3
171 // coef_p7 = -.4468571068774672908561591262231909E-01
172 // coef_p7 in dbl = BFA6 E10B A401 393F
174 // coef_p8 = .2252333246746511135532726960586493E-01
175 // coef_p8 in dbl = 3F97 105B 4160 F86B
177 // coef_p9 = -.7303884867007574742501716845542314E-02
178 // coef_p9 in dbl = BF7D EAAD AA33 6451
180 // coef_p10 = .1109686868355312093949039454619058E-02
181 // coef_p10 in dbl = 3F52 2E5D 33BC 9BAA
185 //==============================================================
192 // +inf +number +pi/2
193 // -inf +number -pi/2
194 // +inf -number +pi/2
195 // -inf -number -pi/2
207 // +number +0 +pi/2 // does not raise DBZ
208 // -number +0 -pi/2 // does not raise DBZ
209 // +number -0 +pi/2 // does not raise DBZ
210 // -number -0 -pi/2 // does not raise DBZ
217 // +0 +0 +0 // does not raise invalid
218 // -0 +0 -0 // does not raise invalid
219 // +0 -0 +pi // does not raise invalid
220 // -0 -0 -pi // does not raise invalid
222 // Nan anything quiet Y
223 // anything NaN quiet X
225 // atan2(+-0/+-0) sets double error tag to 37
226 // atan2f(+-0/+-0) sets single error tag to 38
227 // These are domain errors.
229 #include "libm_support.h"
233 //=========================================
237 atan2f_GR_Addr_1 = r33
238 atan2f_GR_Addr_2 = r34
246 GR_Parameter_RESULT = r40
247 GR_Parameter_TAG = r41
249 // floating point registers
251 atan2f_coef_p10 = f33
262 atan2f_const_piby2 = f42
263 atan2f_const_pi = f43
264 atan2f_const_piby4 = f44
265 atan2f_const_3piby4 = f45
285 atan2f_poly_u109 = f61
286 atan2f_poly_u87 = f62
287 atan2f_poly_u65 = f63
288 atan2f_poly_u43 = f64
289 atan2f_poly_u21 = f65
291 atan2f_poly_u10to7 = f66
292 atan2f_poly_u6to3 = f67
293 atan2f_poly_u10to3 = f68
294 atan2f_poly_u10to0 = f69
295 atan2f_poly_u210 = f70
317 atan2f_poly_atan_U = f88
320 // predicate registers
321 //atan2f_Pred_Swap = p6 // |y| > |x|
322 //atan2f_Pred_noSwap = p7 // |y| <= |x|
323 //atan2f_Pred_Xpos = p8 // x >= 0
324 //atan2f_Pred_Xneg = p9 // x < 0
332 ASM_TYPE_DIRECTIVE(atan2f_coef_table1,@object)
333 data8 0xBFD5555512191621 // p1
334 data8 0x3F522E5D33BC9BAA // p10
335 data8 0xBFA6E10BA401393F // p7
336 data8 0x3FB142A73D7C54E3 // p6
337 data8 0xBFC2473C5145EE38 // p3
338 data8 0x3FC9997E7AFBFF4E // p2
339 ASM_SIZE_DIRECTIVE(atan2f_coef_table1)
342 ASM_TYPE_DIRECTIVE(atan2f_coef_table2,@object)
343 data8 0xBF7DEAADAA336451 // p9
344 data8 0x3F97105B4160F86B // p8
345 data8 0xBFB68EED6A8CFA32 // p5
346 data8 0x3FBC4F512B1865F5 // p4
347 data8 0x3ff921fb54442d18 // pi/2
348 data8 0x400921fb54442d18 // pi
349 data8 0x3fe921fb54442d18 // pi/4
350 data8 0x4002d97c7f3321d2 // 3pi/4
351 ASM_SIZE_DIRECTIVE(atan2f_coef_table2)
358 .global __ieee754_atan2f
369 .proc __ieee754_atan2f
376 alloc r32 = ar.pfs,1,5,4,0
377 frcpa.s1 atan2f_Z0,p0 = f1,f8 // Approx to 1/y
381 addl atan2f_GR_Addr_1 = @ltoff(atan2f_coef_table1),gp
382 fma.s1 atan2f_xsq = f9,f9,f0
388 ld8 atan2f_GR_Addr_1 = [atan2f_GR_Addr_1]
389 frcpa.s1 atan2f_A0,p0 = f1,f9 // Approx to 1/x
394 fma.s1 atan2f_ysq = f8,f8,f0
400 fcmp.ge.s1 p8,p9 = f9,f0 // Set p8 if x>=0, p9 if x<0
405 fma.s1 atan2f_xy = f9,f8,f0
411 add atan2f_GR_Addr_2 = 0x30, atan2f_GR_Addr_1
412 fmerge.s atan2f_sgn_Y = f8,f1
417 ldfpd atan2f_coef_p1,atan2f_coef_p10 = [atan2f_GR_Addr_1],16
418 ldfpd atan2f_coef_p9,atan2f_coef_p8 = [atan2f_GR_Addr_2],16
419 fclass.m p10,p0 = f9,0xe7 // Test x @inf|@snan|@qnan|@zero
424 ldfpd atan2f_coef_p7,atan2f_coef_p6 = [atan2f_GR_Addr_1],16
425 fma.s1 atan2f_T_denom = atan2f_Z0,atan2f_xsq,f8
429 ldfpd atan2f_coef_p5,atan2f_coef_p4 = [atan2f_GR_Addr_2],16
430 fma.s1 atan2f_Z = atan2f_Z0,f9,f0
436 ldfpd atan2f_coef_p3,atan2f_coef_p2 = [atan2f_GR_Addr_1],16
437 fma.s1 atan2f_G_denom = atan2f_A0,atan2f_ysq,f9
441 ldfpd atan2f_const_piby2,atan2f_const_pi = [atan2f_GR_Addr_2],16
442 fma.s1 atan2f_A = atan2f_A0,f8,f0
447 ldfpd atan2f_const_piby4,atan2f_const_3piby4 = [atan2f_GR_Addr_2]
448 fclass.m p11,p0 = f8,0xe7 // Test y @inf|@snan|@qnan|@zero
453 fnma.s1 atan2f_T_numer = atan2f_Z0,atan2f_xy,f9
454 (p10) br.cond.spnt ATAN2F_XY_INF_NAN_ZERO ;; // Branch on x nan,inf,zero
458 // p6 if |y|>|x|, p7 if |x|>=|y| , use xsq and ysq for test
461 fcmp.gt.s1 p6,p7 = atan2f_ysq,atan2f_xsq
466 fnma.s1 atan2f_G_numer = atan2f_A0,atan2f_xy,f8
467 (p11) br.cond.spnt ATAN2F_XY_INF_NAN_ZERO ;; // Branch on y nan,inf,zero
473 (p8) fma.s1 atan2f_const_1 = atan2f_sgn_Y,f0,f0
478 (p9) fma.s1 atan2f_const_1 = atan2f_sgn_Y,f1,f0
485 (p6) fnma.s1 atan2f_U = atan2f_Z,f1,f0
490 (p6) fma.s1 atan2f_Usq = atan2f_Z,atan2f_Z,f0
497 (p7) fma.s1 atan2f_U = atan2f_A,f1,f0
502 (p7) fma.s1 atan2f_Usq = atan2f_A,atan2f_A,f0
509 (p6) frcpa.s1 atan2f_Q1,p0 = f1,atan2f_T_denom
514 (p6) fma.s1 atan2f_R_denom = atan2f_T_denom,f1,f0
521 (p7) frcpa.s1 atan2f_Q1,p0 = f1,atan2f_G_denom
526 (p7) fma.s1 atan2f_R_denom = atan2f_G_denom,f1,f0
533 (p6) fnma.s1 atan2f_R_numer = atan2f_T_numer,f1,f0
538 (p7) fma.s1 atan2f_R_numer = atan2f_G_numer,f1,f0
545 (p6) fnma.s1 atan2f_p1rnum = atan2f_T_numer,atan2f_coef_p1,f0
550 (p7) fma.s1 atan2f_p1rnum = atan2f_G_numer,atan2f_coef_p1,f0
557 fma.s1 atan2f_U4 = atan2f_Usq,atan2f_Usq,f0
562 fma.s1 atan2f_poly_u109 = atan2f_Usq,atan2f_coef_p10,atan2f_coef_p9
568 fma.s1 atan2f_poly_u87 = atan2f_Usq,atan2f_coef_p8,atan2f_coef_p7
573 fma.s1 atan2f_poly_u65 = atan2f_Usq,atan2f_coef_p6,atan2f_coef_p5
580 fma.s1 atan2f_poly_u43 = atan2f_Usq,atan2f_coef_p4,atan2f_coef_p3
585 fnma.s1 atan2f_Q_beta = atan2f_Q1,atan2f_R_denom,f1
592 fma.s1 atan2f_poly_u21 = atan2f_Usq,atan2f_coef_p2,atan2f_coef_p1
597 fma.s1 atan2f_r = atan2f_Q1,atan2f_R_numer,f0
603 (p6) fma.s1 atan2f_C = atan2f_sgn_Y,atan2f_const_piby2,f0
608 (p7) fma.s1 atan2f_C = atan2f_const_1,atan2f_const_pi,f0
614 fma.s1 atan2f_U6 = atan2f_U4,atan2f_Usq,f0
619 fma.s1 atan2f_U8 = atan2f_U4,atan2f_U4,f0
625 fma.s1 atan2f_poly_u10to7 = atan2f_U4,atan2f_poly_u109,atan2f_poly_u87
630 fma.s1 atan2f_pR = atan2f_p1rnum,atan2f_Q1,f0
636 fma.s1 atan2f_poly_u6to3 = atan2f_U4,atan2f_poly_u65,atan2f_poly_u43
641 fma.s1 atan2f_Q2 = atan2f_Q1,atan2f_Q_beta,atan2f_Q1
647 fma.s1 atan2f_Q_beta2 = atan2f_Q_beta,atan2f_Q_beta,f0
652 fma.s1 atan2f_rsq = atan2f_r,atan2f_r,f0
658 fma.s1 atan2f_poly_u210 = atan2f_Usq,atan2f_poly_u21,f1
664 fcmp.eq.s0 p8,p0 = f8,f9 // Dummy op to set flag on denormal inputs
669 fma.s1 atan2f_poly_u10to3 = atan2f_U8,atan2f_poly_u10to7,atan2f_poly_u6to3
675 fma.s1 atan2f_Q3 = atan2f_Q2,atan2f_Q_beta2,atan2f_Q2
680 fma.s1 atan2f_pRC = atan2f_rsq,atan2f_pR,atan2f_C
686 fma.s1 atan2f_poly_u10to0 = atan2f_U6,atan2f_poly_u10to3,atan2f_poly_u210
692 fma.s1 atan2f_pQRC = atan2f_R_numer,atan2f_Q3,atan2f_pRC
698 fma.s.s0 f8 = atan2f_U,atan2f_poly_u10to0,atan2f_pQRC
704 ATAN2F_XY_INF_NAN_ZERO:
708 fclass.m p10,p0 = f8,0xc3 // Is y nan
715 fclass.m p12,p0 = f9,0xc3 // Is x nan
722 fclass.m p6,p0 = f9,0x21 // Is x +inf
727 (p10) fma.s f8 = f9,f8,f0 // Result quietized y if y is nan
728 (p10) br.ret.spnt b0 // Exit if y is nan
735 (p6) fclass.m.unc p7,p8 = f8,0x23 // x +inf, is y inf
740 (p12) fnorm.s f8 = f9 // Result quietized x if x is nan, y not nan
741 (p12) br.ret.spnt b0 // Exit if x is nan, y not nan
745 // Here if x or y inf, or x or y zero
748 fcmp.eq.s0 p15,p0 = f8,f9 // Dummy op to set flag on denormal inputs
755 fclass.m p11,p12 = f9,0x22 // Is x -inf
760 (p7) fma.s f8 = atan2f_sgn_Y, atan2f_const_piby4,f0 // Result +-pi/4
761 (p7) br.ret.spnt b0 // Exit if x +inf and y inf
767 (p8) fmerge.s f8 = f8,f0 // If x +inf and y not inf, result +-0
768 (p8) br.ret.spnt b0 // Exit if x +inf and y not inf
774 (p12) fclass.m.unc p13,p0 = f8,0x23 // x not -inf, is y inf
781 (p11) fclass.m.unc p14,p15 = f8,0x23 // x -inf, is y inf
788 fclass.m p6,p7 = f9,0x7 // Is x zero
793 (p13) fma.s f8 = atan2f_sgn_Y, atan2f_const_piby2,f0 // Result +-pi/2
794 (p13) br.ret.spnt b0 // Exit if x not -inf and y inf
800 (p14) fma.s f8 = atan2f_sgn_Y, atan2f_const_3piby4,f0 // Result +-3pi/4
805 (p15) fma.s f8 = atan2f_sgn_Y, atan2f_const_pi,f0 // Result +-pi
806 (p11) br.ret.spnt b0 // Exit if x -inf
810 // Here if x or y zero
813 (p7) fclass.m.unc p8,p9 = f9,0x19 // x not zero, y zero, is x > zero
820 (p6) fclass.m.unc p10,p11 = f8,0x7 // x zero, is y zero
827 (p8) fmerge.s f8 = f8, f0 // x > zero and y zero, result is +-zero
832 (p9) fma.s f8 = atan2f_sgn_Y, atan2f_const_pi,f0 // x < 0, y 0, result +-pi
833 (p10) br.cond.spnt __libm_error_region // Branch if x zero and y zero
839 (p11) fma.s f8 = atan2f_sgn_Y, atan2f_const_piby2,f0 // x zero, y not zero
840 br.ret.sptk b0 // Final special case exit
846 ASM_SIZE_DIRECTIVE(atan2f)
849 .proc __libm_error_region
852 mov GR_Parameter_TAG = 38
853 fclass.m p10,p11 = f9,0x5 // @zero | @pos
855 (p10) fmerge.s f10 = f8, f0
856 (p11) fma.s f10 = atan2f_sgn_Y, atan2f_const_pi,f0
860 add GR_Parameter_Y=-32,sp // Parameter 2 value
862 .save ar.pfs,GR_SAVE_PFS
863 mov GR_SAVE_PFS=ar.pfs // Save ar.pfs
868 add sp=-64,sp // Create new stack
870 mov GR_SAVE_GP=gp // Save gp
875 stfs [GR_Parameter_Y] = f9,16 // Store Parameter 2 on stack
876 add GR_Parameter_X = 16,sp // Parameter 1 address
878 mov GR_SAVE_B0=b0 // Save b0
885 stfs [GR_Parameter_X] = f8 // Store Parameter 1 on stack
886 add GR_Parameter_RESULT = 0,GR_Parameter_Y
887 nop.b 0 // Parameter 3 address
890 stfs [GR_Parameter_Y] = f10 // Store Parameter 3 on stack
891 add GR_Parameter_Y = -16,GR_Parameter_Y
892 br.call.sptk b0=__libm_error_support# // Call error handling function
898 add GR_Parameter_RESULT = 48,sp
902 ldfs f8 = [GR_Parameter_RESULT] // Get return result off stack
904 add sp = 64,sp // Restore stack pointer
905 mov b0 = GR_SAVE_B0 // Restore return address
910 mov gp = GR_SAVE_GP // Restore gp
911 mov ar.pfs = GR_SAVE_PFS // Restore ar.pfs
912 br.ret.sptk b0 // Return
916 .endp __libm_error_region
917 ASM_SIZE_DIRECTIVE(__libm_error_region)
919 .type __libm_error_support#,@function
920 .global __libm_error_support#