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: 52: 53: 54: 55: 56:
57:
58: #include "math.h"
59: #include "math_private.h"
60:
61: static double pzero(double), qzero(double);
62:
63: static const double
64: huge = 1e300,
65: one = 1.0,
66: invsqrtpi= 5.64189583547756279280e-01,
67: tpi = 6.36619772367581382433e-01,
68:
69: R02 = 1.56249999999999947958e-02,
70: R03 = -1.89979294238854721751e-04,
71: R04 = 1.82954049532700665670e-06,
72: R05 = -4.61832688532103189199e-09,
73: S01 = 1.56191029464890010492e-02,
74: S02 = 1.16926784663337450260e-04,
75: S03 = 5.13546550207318111446e-07,
76: S04 = 1.16614003333790000205e-09;
77:
78: static const double zero = 0.0;
79:
80: double
81: j0(double x)
82: {
83: double z, s,c,ss,cc,r,u,v;
84: int32_t hx,ix;
85:
86: GET_HIGH_WORD(hx,x);
87: ix = hx&0x7fffffff;
88: if(ix>=0x7ff00000) return one/(x*x);
89: x = fabs(x);
90: if(ix >= 0x40000000) {
91: s = sin(x);
92: c = cos(x);
93: ss = s-c;
94: cc = s+c;
95: if(ix<0x7fe00000) {
96: z = -cos(x+x);
97: if ((s*c)<zero) cc = z/ss;
98: else ss = z/cc;
99: }
100: 101: 102: 103:
104: if(ix>0x48000000) z = (invsqrtpi*cc)/sqrt(x);
105: else {
106: u = pzero(x); v = qzero(x);
107: z = invsqrtpi*(u*cc-v*ss)/sqrt(x);
108: }
109: return z;
110: }
111: if(ix<0x3f200000) {
112: if(huge+x>one) {
113: if(ix<0x3e400000) return one;
114: else return one - 0.25*x*x;
115: }
116: }
117: z = x*x;
118: r = z*(R02+z*(R03+z*(R04+z*R05)));
119: s = one+z*(S01+z*(S02+z*(S03+z*S04)));
120: if(ix < 0x3FF00000) {
121: return one + z*(-0.25+(r/s));
122: } else {
123: u = 0.5*x;
124: return((one+u)*(one-u)+z*(r/s));
125: }
126: }
127:
128: static const double
129: u00 = -7.38042951086872317523e-02,
130: u01 = 1.76666452509181115538e-01,
131: u02 = -1.38185671945596898896e-02,
132: u03 = 3.47453432093683650238e-04,
133: u04 = -3.81407053724364161125e-06,
134: u05 = 1.95590137035022920206e-08,
135: u06 = -3.98205194132103398453e-11,
136: v01 = 1.27304834834123699328e-02,
137: v02 = 7.60068627350353253702e-05,
138: v03 = 2.59150851840457805467e-07,
139: v04 = 4.41110311332675467403e-10;
140:
141: double
142: y0(double x)
143: {
144: double z, s,c,ss,cc,u,v;
145: int32_t hx,ix,lx;
146:
147: EXTRACT_WORDS(hx,lx,x);
148: ix = 0x7fffffff&hx;
149:
150: if(ix>=0x7ff00000) return one/(x+x*x);
151: if((ix|lx)==0) return -one/zero;
152: if(hx<0) return zero/zero;
153: if(ix >= 0x40000000) {
154: 155: 156: 157: 158: 159: 160: 161: 162: 163: 164:
165: s = sin(x);
166: c = cos(x);
167: ss = s-c;
168: cc = s+c;
169: 170: 171: 172:
173: if(ix<0x7fe00000) {
174: z = -cos(x+x);
175: if ((s*c)<zero) cc = z/ss;
176: else ss = z/cc;
177: }
178: if(ix>0x48000000) z = (invsqrtpi*ss)/sqrt(x);
179: else {
180: u = pzero(x); v = qzero(x);
181: z = invsqrtpi*(u*ss+v*cc)/sqrt(x);
182: }
183: return z;
184: }
185: if(ix<=0x3e400000) {
186: return(u00 + tpi*log(x));
187: }
188: z = x*x;
189: u = u00+z*(u01+z*(u02+z*(u03+z*(u04+z*(u05+z*u06)))));
190: v = one+z*(v01+z*(v02+z*(v03+z*v04)));
191: return(u/v + tpi*(j0(x)*log(x)));
192: }
193:
194: 195: 196: 197: 198: 199: 200: 201: 202:
203: static const double pR8[6] = {
204: 0.00000000000000000000e+00,
205: -7.03124999999900357484e-02,
206: -8.08167041275349795626e+00,
207: -2.57063105679704847262e+02,
208: -2.48521641009428822144e+03,
209: -5.25304380490729545272e+03,
210: };
211: static const double pS8[5] = {
212: 1.16534364619668181717e+02,
213: 3.83374475364121826715e+03,
214: 4.05978572648472545552e+04,
215: 1.16752972564375915681e+05,
216: 4.76277284146730962675e+04,
217: };
218:
219: static const double pR5[6] = {
220: -1.14125464691894502584e-11,
221: -7.03124940873599280078e-02,
222: -4.15961064470587782438e+00,
223: -6.76747652265167261021e+01,
224: -3.31231299649172967747e+02,
225: -3.46433388365604912451e+02,
226: };
227: static const double pS5[5] = {
228: 6.07539382692300335975e+01,
229: 1.05125230595704579173e+03,
230: 5.97897094333855784498e+03,
231: 9.62544514357774460223e+03,
232: 2.40605815922939109441e+03,
233: };
234:
235: static const double pR3[6] = {
236: -2.54704601771951915620e-09,
237: -7.03119616381481654654e-02,
238: -2.40903221549529611423e+00,
239: -2.19659774734883086467e+01,
240: -5.80791704701737572236e+01,
241: -3.14479470594888503854e+01,
242: };
243: static const double pS3[5] = {
244: 3.58560338055209726349e+01,
245: 3.61513983050303863820e+02,
246: 1.19360783792111533330e+03,
247: 1.12799679856907414432e+03,
248: 1.73580930813335754692e+02,
249: };
250:
251: static const double pR2[6] = {
252: -8.87534333032526411254e-08,
253: -7.03030995483624743247e-02,
254: -1.45073846780952986357e+00,
255: -7.63569613823527770791e+00,
256: -1.11931668860356747786e+01,
257: -3.23364579351335335033e+00,
258: };
259: static const double pS2[5] = {
260: 2.22202997532088808441e+01,
261: 1.36206794218215208048e+02,
262: 2.70470278658083486789e+02,
263: 1.53875394208320329881e+02,
264: 1.46576176948256193810e+01,
265: };
266:
267: static double
268: pzero(double x)
269: {
270: const double *p,*q;
271: double z,r,s;
272: int32_t ix;
273: GET_HIGH_WORD(ix,x);
274: ix &= 0x7fffffff;
275: if(ix>=0x40200000) {p = pR8; q= pS8;}
276: else if(ix>=0x40122E8B){p = pR5; q= pS5;}
277: else if(ix>=0x4006DB6D){p = pR3; q= pS3;}
278: else if(ix>=0x40000000){p = pR2; q= pS2;}
279: z = one/(x*x);
280: r = p[0]+z*(p[1]+z*(p[2]+z*(p[3]+z*(p[4]+z*p[5]))));
281: s = one+z*(q[0]+z*(q[1]+z*(q[2]+z*(q[3]+z*q[4]))));
282: return one+ r/s;
283: }
284:
285:
286: 287: 288: 289: 290: 291: 292: 293: 294:
295: static const double qR8[6] = {
296: 0.00000000000000000000e+00,
297: 7.32421874999935051953e-02,
298: 1.17682064682252693899e+01,
299: 5.57673380256401856059e+02,
300: 8.85919720756468632317e+03,
301: 3.70146267776887834771e+04,
302: };
303: static const double qS8[6] = {
304: 1.63776026895689824414e+02,
305: 8.09834494656449805916e+03,
306: 1.42538291419120476348e+05,
307: 8.03309257119514397345e+05,
308: 8.40501579819060512818e+05,
309: -3.43899293537866615225e+05,
310: };
311:
312: static const double qR5[6] = {
313: 1.84085963594515531381e-11,
314: 7.32421766612684765896e-02,
315: 5.83563508962056953777e+00,
316: 1.35111577286449829671e+02,
317: 1.02724376596164097464e+03,
318: 1.98997785864605384631e+03,
319: };
320: static const double qS5[6] = {
321: 8.27766102236537761883e+01,
322: 2.07781416421392987104e+03,
323: 1.88472887785718085070e+04,
324: 5.67511122894947329769e+04,
325: 3.59767538425114471465e+04,
326: -5.35434275601944773371e+03,
327: };
328:
329: static const double qR3[6] = {
330: 4.37741014089738620906e-09,
331: 7.32411180042911447163e-02,
332: 3.34423137516170720929e+00,
333: 4.26218440745412650017e+01,
334: 1.70808091340565596283e+02,
335: 1.66733948696651168575e+02,
336: };
337: static const double qS3[6] = {
338: 4.87588729724587182091e+01,
339: 7.09689221056606015736e+02,
340: 3.70414822620111362994e+03,
341: 6.46042516752568917582e+03,
342: 2.51633368920368957333e+03,
343: -1.49247451836156386662e+02,
344: };
345:
346: static const double qR2[6] = {
347: 1.50444444886983272379e-07,
348: 7.32234265963079278272e-02,
349: 1.99819174093815998816e+00,
350: 1.44956029347885735348e+01,
351: 3.16662317504781540833e+01,
352: 1.62527075710929267416e+01,
353: };
354: static const double qS2[6] = {
355: 3.03655848355219184498e+01,
356: 2.69348118608049844624e+02,
357: 8.44783757595320139444e+02,
358: 8.82935845112488550512e+02,
359: 2.12666388511798828631e+02,
360: -5.31095493882666946917e+00,
361: };
362:
363: static double
364: qzero(double x)
365: {
366: const double *p,*q;
367: double s,r,z;
368: int32_t ix;
369: GET_HIGH_WORD(ix,x);
370: ix &= 0x7fffffff;
371: if(ix>=0x40200000) {p = qR8; q= qS8;}
372: else if(ix>=0x40122E8B){p = qR5; q= qS5;}
373: else if(ix>=0x4006DB6D){p = qR3; q= qS3;}
374: else if(ix>=0x40000000){p = qR2; q= qS2;}
375: z = one/(x*x);
376: r = p[0]+z*(p[1]+z*(p[2]+z*(p[3]+z*(p[4]+z*p[5]))));
377: s = one+z*(q[0]+z*(q[1]+z*(q[2]+z*(q[3]+z*(q[4]+z*q[5])))));
378: return (-.125 + r/s)/x;
379: }