Root/
1 | /* Software floating-point emulation. Common operations. |
2 | Copyright (C) 1997,1998,1999 Free Software Foundation, Inc. |
3 | This file is part of the GNU C Library. |
4 | Contributed by Richard Henderson (rth@cygnus.com), |
5 | Jakub Jelinek (jj@ultra.linux.cz), |
6 | David S. Miller (davem@redhat.com) and |
7 | Peter Maydell (pmaydell@chiark.greenend.org.uk). |
8 | |
9 | The GNU C Library is free software; you can redistribute it and/or |
10 | modify it under the terms of the GNU Library General Public License as |
11 | published by the Free Software Foundation; either version 2 of the |
12 | License, or (at your option) any later version. |
13 | |
14 | The GNU C Library is distributed in the hope that it will be useful, |
15 | but WITHOUT ANY WARRANTY; without even the implied warranty of |
16 | MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU |
17 | Library General Public License for more details. |
18 | |
19 | You should have received a copy of the GNU Library General Public |
20 | License along with the GNU C Library; see the file COPYING.LIB. If |
21 | not, write to the Free Software Foundation, Inc., |
22 | 59 Temple Place - Suite 330, Boston, MA 02111-1307, USA. */ |
23 | |
24 | #ifndef __MATH_EMU_OP_COMMON_H__ |
25 | #define __MATH_EMU_OP_COMMON_H__ |
26 | |
27 | #define _FP_DECL(wc, X) \ |
28 | _FP_I_TYPE X##_c=0, X##_s=0, X##_e=0; \ |
29 | _FP_FRAC_DECL_##wc(X) |
30 | |
31 | /* |
32 | * Finish truly unpacking a native fp value by classifying the kind |
33 | * of fp value and normalizing both the exponent and the fraction. |
34 | */ |
35 | |
36 | #define _FP_UNPACK_CANONICAL(fs, wc, X) \ |
37 | do { \ |
38 | switch (X##_e) \ |
39 | { \ |
40 | default: \ |
41 | _FP_FRAC_HIGH_RAW_##fs(X) |= _FP_IMPLBIT_##fs; \ |
42 | _FP_FRAC_SLL_##wc(X, _FP_WORKBITS); \ |
43 | X##_e -= _FP_EXPBIAS_##fs; \ |
44 | X##_c = FP_CLS_NORMAL; \ |
45 | break; \ |
46 | \ |
47 | case 0: \ |
48 | if (_FP_FRAC_ZEROP_##wc(X)) \ |
49 | X##_c = FP_CLS_ZERO; \ |
50 | else \ |
51 | { \ |
52 | /* a denormalized number */ \ |
53 | _FP_I_TYPE _shift; \ |
54 | _FP_FRAC_CLZ_##wc(_shift, X); \ |
55 | _shift -= _FP_FRACXBITS_##fs; \ |
56 | _FP_FRAC_SLL_##wc(X, (_shift+_FP_WORKBITS)); \ |
57 | X##_e -= _FP_EXPBIAS_##fs - 1 + _shift; \ |
58 | X##_c = FP_CLS_NORMAL; \ |
59 | FP_SET_EXCEPTION(FP_EX_DENORM); \ |
60 | if (FP_DENORM_ZERO) \ |
61 | { \ |
62 | FP_SET_EXCEPTION(FP_EX_INEXACT); \ |
63 | X##_c = FP_CLS_ZERO; \ |
64 | } \ |
65 | } \ |
66 | break; \ |
67 | \ |
68 | case _FP_EXPMAX_##fs: \ |
69 | if (_FP_FRAC_ZEROP_##wc(X)) \ |
70 | X##_c = FP_CLS_INF; \ |
71 | else \ |
72 | { \ |
73 | X##_c = FP_CLS_NAN; \ |
74 | /* Check for signaling NaN */ \ |
75 | if (!(_FP_FRAC_HIGH_RAW_##fs(X) & _FP_QNANBIT_##fs)) \ |
76 | FP_SET_EXCEPTION(FP_EX_INVALID | FP_EX_INVALID_SNAN); \ |
77 | } \ |
78 | break; \ |
79 | } \ |
80 | } while (0) |
81 | |
82 | /* |
83 | * Before packing the bits back into the native fp result, take care |
84 | * of such mundane things as rounding and overflow. Also, for some |
85 | * kinds of fp values, the original parts may not have been fully |
86 | * extracted -- but that is ok, we can regenerate them now. |
87 | */ |
88 | |
89 | #define _FP_PACK_CANONICAL(fs, wc, X) \ |
90 | do { \ |
91 | switch (X##_c) \ |
92 | { \ |
93 | case FP_CLS_NORMAL: \ |
94 | X##_e += _FP_EXPBIAS_##fs; \ |
95 | if (X##_e > 0) \ |
96 | { \ |
97 | _FP_ROUND(wc, X); \ |
98 | if (_FP_FRAC_OVERP_##wc(fs, X)) \ |
99 | { \ |
100 | _FP_FRAC_CLEAR_OVERP_##wc(fs, X); \ |
101 | X##_e++; \ |
102 | } \ |
103 | _FP_FRAC_SRL_##wc(X, _FP_WORKBITS); \ |
104 | if (X##_e >= _FP_EXPMAX_##fs) \ |
105 | { \ |
106 | /* overflow */ \ |
107 | switch (FP_ROUNDMODE) \ |
108 | { \ |
109 | case FP_RND_NEAREST: \ |
110 | X##_c = FP_CLS_INF; \ |
111 | break; \ |
112 | case FP_RND_PINF: \ |
113 | if (!X##_s) X##_c = FP_CLS_INF; \ |
114 | break; \ |
115 | case FP_RND_MINF: \ |
116 | if (X##_s) X##_c = FP_CLS_INF; \ |
117 | break; \ |
118 | } \ |
119 | if (X##_c == FP_CLS_INF) \ |
120 | { \ |
121 | /* Overflow to infinity */ \ |
122 | X##_e = _FP_EXPMAX_##fs; \ |
123 | _FP_FRAC_SET_##wc(X, _FP_ZEROFRAC_##wc); \ |
124 | } \ |
125 | else \ |
126 | { \ |
127 | /* Overflow to maximum normal */ \ |
128 | X##_e = _FP_EXPMAX_##fs - 1; \ |
129 | _FP_FRAC_SET_##wc(X, _FP_MAXFRAC_##wc); \ |
130 | } \ |
131 | FP_SET_EXCEPTION(FP_EX_OVERFLOW); \ |
132 | FP_SET_EXCEPTION(FP_EX_INEXACT); \ |
133 | } \ |
134 | } \ |
135 | else \ |
136 | { \ |
137 | /* we've got a denormalized number */ \ |
138 | X##_e = -X##_e + 1; \ |
139 | if (X##_e <= _FP_WFRACBITS_##fs) \ |
140 | { \ |
141 | _FP_FRAC_SRS_##wc(X, X##_e, _FP_WFRACBITS_##fs); \ |
142 | if (_FP_FRAC_HIGH_##fs(X) \ |
143 | & (_FP_OVERFLOW_##fs >> 1)) \ |
144 | { \ |
145 | X##_e = 1; \ |
146 | _FP_FRAC_SET_##wc(X, _FP_ZEROFRAC_##wc); \ |
147 | } \ |
148 | else \ |
149 | { \ |
150 | _FP_ROUND(wc, X); \ |
151 | if (_FP_FRAC_HIGH_##fs(X) \ |
152 | & (_FP_OVERFLOW_##fs >> 1)) \ |
153 | { \ |
154 | X##_e = 1; \ |
155 | _FP_FRAC_SET_##wc(X, _FP_ZEROFRAC_##wc); \ |
156 | FP_SET_EXCEPTION(FP_EX_INEXACT); \ |
157 | } \ |
158 | else \ |
159 | { \ |
160 | X##_e = 0; \ |
161 | _FP_FRAC_SRL_##wc(X, _FP_WORKBITS); \ |
162 | } \ |
163 | } \ |
164 | if ((FP_CUR_EXCEPTIONS & FP_EX_INEXACT) || \ |
165 | (FP_TRAPPING_EXCEPTIONS & FP_EX_UNDERFLOW)) \ |
166 | FP_SET_EXCEPTION(FP_EX_UNDERFLOW); \ |
167 | } \ |
168 | else \ |
169 | { \ |
170 | /* underflow to zero */ \ |
171 | X##_e = 0; \ |
172 | if (!_FP_FRAC_ZEROP_##wc(X)) \ |
173 | { \ |
174 | _FP_FRAC_SET_##wc(X, _FP_MINFRAC_##wc); \ |
175 | _FP_ROUND(wc, X); \ |
176 | _FP_FRAC_LOW_##wc(X) >>= (_FP_WORKBITS); \ |
177 | } \ |
178 | FP_SET_EXCEPTION(FP_EX_UNDERFLOW); \ |
179 | } \ |
180 | } \ |
181 | break; \ |
182 | \ |
183 | case FP_CLS_ZERO: \ |
184 | X##_e = 0; \ |
185 | _FP_FRAC_SET_##wc(X, _FP_ZEROFRAC_##wc); \ |
186 | break; \ |
187 | \ |
188 | case FP_CLS_INF: \ |
189 | X##_e = _FP_EXPMAX_##fs; \ |
190 | _FP_FRAC_SET_##wc(X, _FP_ZEROFRAC_##wc); \ |
191 | break; \ |
192 | \ |
193 | case FP_CLS_NAN: \ |
194 | X##_e = _FP_EXPMAX_##fs; \ |
195 | if (!_FP_KEEPNANFRACP) \ |
196 | { \ |
197 | _FP_FRAC_SET_##wc(X, _FP_NANFRAC_##fs); \ |
198 | X##_s = _FP_NANSIGN_##fs; \ |
199 | } \ |
200 | else \ |
201 | _FP_FRAC_HIGH_RAW_##fs(X) |= _FP_QNANBIT_##fs; \ |
202 | break; \ |
203 | } \ |
204 | } while (0) |
205 | |
206 | /* This one accepts raw argument and not cooked, returns |
207 | * 1 if X is a signaling NaN. |
208 | */ |
209 | #define _FP_ISSIGNAN(fs, wc, X) \ |
210 | ({ \ |
211 | int __ret = 0; \ |
212 | if (X##_e == _FP_EXPMAX_##fs) \ |
213 | { \ |
214 | if (!_FP_FRAC_ZEROP_##wc(X) \ |
215 | && !(_FP_FRAC_HIGH_RAW_##fs(X) & _FP_QNANBIT_##fs)) \ |
216 | __ret = 1; \ |
217 | } \ |
218 | __ret; \ |
219 | }) |
220 | |
221 | |
222 | |
223 | |
224 | |
225 | /* |
226 | * Main addition routine. The input values should be cooked. |
227 | */ |
228 | |
229 | #define _FP_ADD_INTERNAL(fs, wc, R, X, Y, OP) \ |
230 | do { \ |
231 | switch (_FP_CLS_COMBINE(X##_c, Y##_c)) \ |
232 | { \ |
233 | case _FP_CLS_COMBINE(FP_CLS_NORMAL,FP_CLS_NORMAL): \ |
234 | { \ |
235 | /* shift the smaller number so that its exponent matches the larger */ \ |
236 | _FP_I_TYPE diff = X##_e - Y##_e; \ |
237 | \ |
238 | if (diff < 0) \ |
239 | { \ |
240 | diff = -diff; \ |
241 | if (diff <= _FP_WFRACBITS_##fs) \ |
242 | _FP_FRAC_SRS_##wc(X, diff, _FP_WFRACBITS_##fs); \ |
243 | else if (!_FP_FRAC_ZEROP_##wc(X)) \ |
244 | _FP_FRAC_SET_##wc(X, _FP_MINFRAC_##wc); \ |
245 | R##_e = Y##_e; \ |
246 | } \ |
247 | else \ |
248 | { \ |
249 | if (diff > 0) \ |
250 | { \ |
251 | if (diff <= _FP_WFRACBITS_##fs) \ |
252 | _FP_FRAC_SRS_##wc(Y, diff, _FP_WFRACBITS_##fs); \ |
253 | else if (!_FP_FRAC_ZEROP_##wc(Y)) \ |
254 | _FP_FRAC_SET_##wc(Y, _FP_MINFRAC_##wc); \ |
255 | } \ |
256 | R##_e = X##_e; \ |
257 | } \ |
258 | \ |
259 | R##_c = FP_CLS_NORMAL; \ |
260 | \ |
261 | if (X##_s == Y##_s) \ |
262 | { \ |
263 | R##_s = X##_s; \ |
264 | _FP_FRAC_ADD_##wc(R, X, Y); \ |
265 | if (_FP_FRAC_OVERP_##wc(fs, R)) \ |
266 | { \ |
267 | _FP_FRAC_SRS_##wc(R, 1, _FP_WFRACBITS_##fs); \ |
268 | R##_e++; \ |
269 | } \ |
270 | } \ |
271 | else \ |
272 | { \ |
273 | R##_s = X##_s; \ |
274 | _FP_FRAC_SUB_##wc(R, X, Y); \ |
275 | if (_FP_FRAC_ZEROP_##wc(R)) \ |
276 | { \ |
277 | /* return an exact zero */ \ |
278 | if (FP_ROUNDMODE == FP_RND_MINF) \ |
279 | R##_s |= Y##_s; \ |
280 | else \ |
281 | R##_s &= Y##_s; \ |
282 | R##_c = FP_CLS_ZERO; \ |
283 | } \ |
284 | else \ |
285 | { \ |
286 | if (_FP_FRAC_NEGP_##wc(R)) \ |
287 | { \ |
288 | _FP_FRAC_SUB_##wc(R, Y, X); \ |
289 | R##_s = Y##_s; \ |
290 | } \ |
291 | \ |
292 | /* renormalize after subtraction */ \ |
293 | _FP_FRAC_CLZ_##wc(diff, R); \ |
294 | diff -= _FP_WFRACXBITS_##fs; \ |
295 | if (diff) \ |
296 | { \ |
297 | R##_e -= diff; \ |
298 | _FP_FRAC_SLL_##wc(R, diff); \ |
299 | } \ |
300 | } \ |
301 | } \ |
302 | break; \ |
303 | } \ |
304 | \ |
305 | case _FP_CLS_COMBINE(FP_CLS_NAN,FP_CLS_NAN): \ |
306 | _FP_CHOOSENAN(fs, wc, R, X, Y, OP); \ |
307 | break; \ |
308 | \ |
309 | case _FP_CLS_COMBINE(FP_CLS_NORMAL,FP_CLS_ZERO): \ |
310 | R##_e = X##_e; \ |
311 | case _FP_CLS_COMBINE(FP_CLS_NAN,FP_CLS_NORMAL): \ |
312 | case _FP_CLS_COMBINE(FP_CLS_NAN,FP_CLS_INF): \ |
313 | case _FP_CLS_COMBINE(FP_CLS_NAN,FP_CLS_ZERO): \ |
314 | _FP_FRAC_COPY_##wc(R, X); \ |
315 | R##_s = X##_s; \ |
316 | R##_c = X##_c; \ |
317 | break; \ |
318 | \ |
319 | case _FP_CLS_COMBINE(FP_CLS_ZERO,FP_CLS_NORMAL): \ |
320 | R##_e = Y##_e; \ |
321 | case _FP_CLS_COMBINE(FP_CLS_NORMAL,FP_CLS_NAN): \ |
322 | case _FP_CLS_COMBINE(FP_CLS_INF,FP_CLS_NAN): \ |
323 | case _FP_CLS_COMBINE(FP_CLS_ZERO,FP_CLS_NAN): \ |
324 | _FP_FRAC_COPY_##wc(R, Y); \ |
325 | R##_s = Y##_s; \ |
326 | R##_c = Y##_c; \ |
327 | break; \ |
328 | \ |
329 | case _FP_CLS_COMBINE(FP_CLS_INF,FP_CLS_INF): \ |
330 | if (X##_s != Y##_s) \ |
331 | { \ |
332 | /* +INF + -INF => NAN */ \ |
333 | _FP_FRAC_SET_##wc(R, _FP_NANFRAC_##fs); \ |
334 | R##_s = _FP_NANSIGN_##fs; \ |
335 | R##_c = FP_CLS_NAN; \ |
336 | FP_SET_EXCEPTION(FP_EX_INVALID | FP_EX_INVALID_ISI); \ |
337 | break; \ |
338 | } \ |
339 | /* FALLTHRU */ \ |
340 | \ |
341 | case _FP_CLS_COMBINE(FP_CLS_INF,FP_CLS_NORMAL): \ |
342 | case _FP_CLS_COMBINE(FP_CLS_INF,FP_CLS_ZERO): \ |
343 | R##_s = X##_s; \ |
344 | R##_c = FP_CLS_INF; \ |
345 | break; \ |
346 | \ |
347 | case _FP_CLS_COMBINE(FP_CLS_NORMAL,FP_CLS_INF): \ |
348 | case _FP_CLS_COMBINE(FP_CLS_ZERO,FP_CLS_INF): \ |
349 | R##_s = Y##_s; \ |
350 | R##_c = FP_CLS_INF; \ |
351 | break; \ |
352 | \ |
353 | case _FP_CLS_COMBINE(FP_CLS_ZERO,FP_CLS_ZERO): \ |
354 | /* make sure the sign is correct */ \ |
355 | if (FP_ROUNDMODE == FP_RND_MINF) \ |
356 | R##_s = X##_s | Y##_s; \ |
357 | else \ |
358 | R##_s = X##_s & Y##_s; \ |
359 | R##_c = FP_CLS_ZERO; \ |
360 | break; \ |
361 | \ |
362 | default: \ |
363 | abort(); \ |
364 | } \ |
365 | } while (0) |
366 | |
367 | #define _FP_ADD(fs, wc, R, X, Y) _FP_ADD_INTERNAL(fs, wc, R, X, Y, '+') |
368 | #define _FP_SUB(fs, wc, R, X, Y) \ |
369 | do { \ |
370 | if (Y##_c != FP_CLS_NAN) Y##_s ^= 1; \ |
371 | _FP_ADD_INTERNAL(fs, wc, R, X, Y, '-'); \ |
372 | } while (0) |
373 | |
374 | |
375 | /* |
376 | * Main negation routine. FIXME -- when we care about setting exception |
377 | * bits reliably, this will not do. We should examine all of the fp classes. |
378 | */ |
379 | |
380 | #define _FP_NEG(fs, wc, R, X) \ |
381 | do { \ |
382 | _FP_FRAC_COPY_##wc(R, X); \ |
383 | R##_c = X##_c; \ |
384 | R##_e = X##_e; \ |
385 | R##_s = 1 ^ X##_s; \ |
386 | } while (0) |
387 | |
388 | |
389 | /* |
390 | * Main multiplication routine. The input values should be cooked. |
391 | */ |
392 | |
393 | #define _FP_MUL(fs, wc, R, X, Y) \ |
394 | do { \ |
395 | R##_s = X##_s ^ Y##_s; \ |
396 | switch (_FP_CLS_COMBINE(X##_c, Y##_c)) \ |
397 | { \ |
398 | case _FP_CLS_COMBINE(FP_CLS_NORMAL,FP_CLS_NORMAL): \ |
399 | R##_c = FP_CLS_NORMAL; \ |
400 | R##_e = X##_e + Y##_e + 1; \ |
401 | \ |
402 | _FP_MUL_MEAT_##fs(R,X,Y); \ |
403 | \ |
404 | if (_FP_FRAC_OVERP_##wc(fs, R)) \ |
405 | _FP_FRAC_SRS_##wc(R, 1, _FP_WFRACBITS_##fs); \ |
406 | else \ |
407 | R##_e--; \ |
408 | break; \ |
409 | \ |
410 | case _FP_CLS_COMBINE(FP_CLS_NAN,FP_CLS_NAN): \ |
411 | _FP_CHOOSENAN(fs, wc, R, X, Y, '*'); \ |
412 | break; \ |
413 | \ |
414 | case _FP_CLS_COMBINE(FP_CLS_NAN,FP_CLS_NORMAL): \ |
415 | case _FP_CLS_COMBINE(FP_CLS_NAN,FP_CLS_INF): \ |
416 | case _FP_CLS_COMBINE(FP_CLS_NAN,FP_CLS_ZERO): \ |
417 | R##_s = X##_s; \ |
418 | \ |
419 | case _FP_CLS_COMBINE(FP_CLS_INF,FP_CLS_INF): \ |
420 | case _FP_CLS_COMBINE(FP_CLS_INF,FP_CLS_NORMAL): \ |
421 | case _FP_CLS_COMBINE(FP_CLS_ZERO,FP_CLS_NORMAL): \ |
422 | case _FP_CLS_COMBINE(FP_CLS_ZERO,FP_CLS_ZERO): \ |
423 | _FP_FRAC_COPY_##wc(R, X); \ |
424 | R##_c = X##_c; \ |
425 | break; \ |
426 | \ |
427 | case _FP_CLS_COMBINE(FP_CLS_NORMAL,FP_CLS_NAN): \ |
428 | case _FP_CLS_COMBINE(FP_CLS_INF,FP_CLS_NAN): \ |
429 | case _FP_CLS_COMBINE(FP_CLS_ZERO,FP_CLS_NAN): \ |
430 | R##_s = Y##_s; \ |
431 | \ |
432 | case _FP_CLS_COMBINE(FP_CLS_NORMAL,FP_CLS_INF): \ |
433 | case _FP_CLS_COMBINE(FP_CLS_NORMAL,FP_CLS_ZERO): \ |
434 | _FP_FRAC_COPY_##wc(R, Y); \ |
435 | R##_c = Y##_c; \ |
436 | break; \ |
437 | \ |
438 | case _FP_CLS_COMBINE(FP_CLS_INF,FP_CLS_ZERO): \ |
439 | case _FP_CLS_COMBINE(FP_CLS_ZERO,FP_CLS_INF): \ |
440 | R##_s = _FP_NANSIGN_##fs; \ |
441 | R##_c = FP_CLS_NAN; \ |
442 | _FP_FRAC_SET_##wc(R, _FP_NANFRAC_##fs); \ |
443 | FP_SET_EXCEPTION(FP_EX_INVALID | FP_EX_INVALID_IMZ);\ |
444 | break; \ |
445 | \ |
446 | default: \ |
447 | abort(); \ |
448 | } \ |
449 | } while (0) |
450 | |
451 | |
452 | /* |
453 | * Main division routine. The input values should be cooked. |
454 | */ |
455 | |
456 | #define _FP_DIV(fs, wc, R, X, Y) \ |
457 | do { \ |
458 | R##_s = X##_s ^ Y##_s; \ |
459 | switch (_FP_CLS_COMBINE(X##_c, Y##_c)) \ |
460 | { \ |
461 | case _FP_CLS_COMBINE(FP_CLS_NORMAL,FP_CLS_NORMAL): \ |
462 | R##_c = FP_CLS_NORMAL; \ |
463 | R##_e = X##_e - Y##_e; \ |
464 | \ |
465 | _FP_DIV_MEAT_##fs(R,X,Y); \ |
466 | break; \ |
467 | \ |
468 | case _FP_CLS_COMBINE(FP_CLS_NAN,FP_CLS_NAN): \ |
469 | _FP_CHOOSENAN(fs, wc, R, X, Y, '/'); \ |
470 | break; \ |
471 | \ |
472 | case _FP_CLS_COMBINE(FP_CLS_NAN,FP_CLS_NORMAL): \ |
473 | case _FP_CLS_COMBINE(FP_CLS_NAN,FP_CLS_INF): \ |
474 | case _FP_CLS_COMBINE(FP_CLS_NAN,FP_CLS_ZERO): \ |
475 | R##_s = X##_s; \ |
476 | _FP_FRAC_COPY_##wc(R, X); \ |
477 | R##_c = X##_c; \ |
478 | break; \ |
479 | \ |
480 | case _FP_CLS_COMBINE(FP_CLS_NORMAL,FP_CLS_NAN): \ |
481 | case _FP_CLS_COMBINE(FP_CLS_INF,FP_CLS_NAN): \ |
482 | case _FP_CLS_COMBINE(FP_CLS_ZERO,FP_CLS_NAN): \ |
483 | R##_s = Y##_s; \ |
484 | _FP_FRAC_COPY_##wc(R, Y); \ |
485 | R##_c = Y##_c; \ |
486 | break; \ |
487 | \ |
488 | case _FP_CLS_COMBINE(FP_CLS_NORMAL,FP_CLS_INF): \ |
489 | case _FP_CLS_COMBINE(FP_CLS_ZERO,FP_CLS_INF): \ |
490 | case _FP_CLS_COMBINE(FP_CLS_ZERO,FP_CLS_NORMAL): \ |
491 | R##_c = FP_CLS_ZERO; \ |
492 | break; \ |
493 | \ |
494 | case _FP_CLS_COMBINE(FP_CLS_NORMAL,FP_CLS_ZERO): \ |
495 | FP_SET_EXCEPTION(FP_EX_DIVZERO); \ |
496 | case _FP_CLS_COMBINE(FP_CLS_INF,FP_CLS_ZERO): \ |
497 | case _FP_CLS_COMBINE(FP_CLS_INF,FP_CLS_NORMAL): \ |
498 | R##_c = FP_CLS_INF; \ |
499 | break; \ |
500 | \ |
501 | case _FP_CLS_COMBINE(FP_CLS_INF,FP_CLS_INF): \ |
502 | R##_s = _FP_NANSIGN_##fs; \ |
503 | R##_c = FP_CLS_NAN; \ |
504 | _FP_FRAC_SET_##wc(R, _FP_NANFRAC_##fs); \ |
505 | FP_SET_EXCEPTION(FP_EX_INVALID | FP_EX_INVALID_IDI);\ |
506 | break; \ |
507 | \ |
508 | case _FP_CLS_COMBINE(FP_CLS_ZERO,FP_CLS_ZERO): \ |
509 | R##_s = _FP_NANSIGN_##fs; \ |
510 | R##_c = FP_CLS_NAN; \ |
511 | _FP_FRAC_SET_##wc(R, _FP_NANFRAC_##fs); \ |
512 | FP_SET_EXCEPTION(FP_EX_INVALID | FP_EX_INVALID_ZDZ);\ |
513 | break; \ |
514 | \ |
515 | default: \ |
516 | abort(); \ |
517 | } \ |
518 | } while (0) |
519 | |
520 | |
521 | /* |
522 | * Main differential comparison routine. The inputs should be raw not |
523 | * cooked. The return is -1,0,1 for normal values, 2 otherwise. |
524 | */ |
525 | |
526 | #define _FP_CMP(fs, wc, ret, X, Y, un) \ |
527 | do { \ |
528 | /* NANs are unordered */ \ |
529 | if ((X##_e == _FP_EXPMAX_##fs && !_FP_FRAC_ZEROP_##wc(X)) \ |
530 | || (Y##_e == _FP_EXPMAX_##fs && !_FP_FRAC_ZEROP_##wc(Y))) \ |
531 | { \ |
532 | ret = un; \ |
533 | } \ |
534 | else \ |
535 | { \ |
536 | int __is_zero_x; \ |
537 | int __is_zero_y; \ |
538 | \ |
539 | __is_zero_x = (!X##_e && _FP_FRAC_ZEROP_##wc(X)) ? 1 : 0; \ |
540 | __is_zero_y = (!Y##_e && _FP_FRAC_ZEROP_##wc(Y)) ? 1 : 0; \ |
541 | \ |
542 | if (__is_zero_x && __is_zero_y) \ |
543 | ret = 0; \ |
544 | else if (__is_zero_x) \ |
545 | ret = Y##_s ? 1 : -1; \ |
546 | else if (__is_zero_y) \ |
547 | ret = X##_s ? -1 : 1; \ |
548 | else if (X##_s != Y##_s) \ |
549 | ret = X##_s ? -1 : 1; \ |
550 | else if (X##_e > Y##_e) \ |
551 | ret = X##_s ? -1 : 1; \ |
552 | else if (X##_e < Y##_e) \ |
553 | ret = X##_s ? 1 : -1; \ |
554 | else if (_FP_FRAC_GT_##wc(X, Y)) \ |
555 | ret = X##_s ? -1 : 1; \ |
556 | else if (_FP_FRAC_GT_##wc(Y, X)) \ |
557 | ret = X##_s ? 1 : -1; \ |
558 | else \ |
559 | ret = 0; \ |
560 | } \ |
561 | } while (0) |
562 | |
563 | |
564 | /* Simplification for strict equality. */ |
565 | |
566 | #define _FP_CMP_EQ(fs, wc, ret, X, Y) \ |
567 | do { \ |
568 | /* NANs are unordered */ \ |
569 | if ((X##_e == _FP_EXPMAX_##fs && !_FP_FRAC_ZEROP_##wc(X)) \ |
570 | || (Y##_e == _FP_EXPMAX_##fs && !_FP_FRAC_ZEROP_##wc(Y))) \ |
571 | { \ |
572 | ret = 1; \ |
573 | } \ |
574 | else \ |
575 | { \ |
576 | ret = !(X##_e == Y##_e \ |
577 | && _FP_FRAC_EQ_##wc(X, Y) \ |
578 | && (X##_s == Y##_s || !X##_e && _FP_FRAC_ZEROP_##wc(X))); \ |
579 | } \ |
580 | } while (0) |
581 | |
582 | /* |
583 | * Main square root routine. The input value should be cooked. |
584 | */ |
585 | |
586 | #define _FP_SQRT(fs, wc, R, X) \ |
587 | do { \ |
588 | _FP_FRAC_DECL_##wc(T); _FP_FRAC_DECL_##wc(S); \ |
589 | _FP_W_TYPE q; \ |
590 | switch (X##_c) \ |
591 | { \ |
592 | case FP_CLS_NAN: \ |
593 | _FP_FRAC_COPY_##wc(R, X); \ |
594 | R##_s = X##_s; \ |
595 | R##_c = FP_CLS_NAN; \ |
596 | break; \ |
597 | case FP_CLS_INF: \ |
598 | if (X##_s) \ |
599 | { \ |
600 | R##_s = _FP_NANSIGN_##fs; \ |
601 | R##_c = FP_CLS_NAN; /* NAN */ \ |
602 | _FP_FRAC_SET_##wc(R, _FP_NANFRAC_##fs); \ |
603 | FP_SET_EXCEPTION(FP_EX_INVALID); \ |
604 | } \ |
605 | else \ |
606 | { \ |
607 | R##_s = 0; \ |
608 | R##_c = FP_CLS_INF; /* sqrt(+inf) = +inf */ \ |
609 | } \ |
610 | break; \ |
611 | case FP_CLS_ZERO: \ |
612 | R##_s = X##_s; \ |
613 | R##_c = FP_CLS_ZERO; /* sqrt(+-0) = +-0 */ \ |
614 | break; \ |
615 | case FP_CLS_NORMAL: \ |
616 | R##_s = 0; \ |
617 | if (X##_s) \ |
618 | { \ |
619 | R##_c = FP_CLS_NAN; /* sNAN */ \ |
620 | R##_s = _FP_NANSIGN_##fs; \ |
621 | _FP_FRAC_SET_##wc(R, _FP_NANFRAC_##fs); \ |
622 | FP_SET_EXCEPTION(FP_EX_INVALID); \ |
623 | break; \ |
624 | } \ |
625 | R##_c = FP_CLS_NORMAL; \ |
626 | if (X##_e & 1) \ |
627 | _FP_FRAC_SLL_##wc(X, 1); \ |
628 | R##_e = X##_e >> 1; \ |
629 | _FP_FRAC_SET_##wc(S, _FP_ZEROFRAC_##wc); \ |
630 | _FP_FRAC_SET_##wc(R, _FP_ZEROFRAC_##wc); \ |
631 | q = _FP_OVERFLOW_##fs >> 1; \ |
632 | _FP_SQRT_MEAT_##wc(R, S, T, X, q); \ |
633 | } \ |
634 | } while (0) |
635 | |
636 | /* |
637 | * Convert from FP to integer |
638 | */ |
639 | |
640 | /* RSIGNED can have following values: |
641 | * 0: the number is required to be 0..(2^rsize)-1, if not, NV is set plus |
642 | * the result is either 0 or (2^rsize)-1 depending on the sign in such case. |
643 | * 1: the number is required to be -(2^(rsize-1))..(2^(rsize-1))-1, if not, NV is |
644 | * set plus the result is either -(2^(rsize-1)) or (2^(rsize-1))-1 depending |
645 | * on the sign in such case. |
646 | * 2: the number is required to be -(2^(rsize-1))..(2^(rsize-1))-1, if not, NV is |
647 | * set plus the result is truncated to fit into destination. |
648 | * -1: the number is required to be -(2^(rsize-1))..(2^rsize)-1, if not, NV is |
649 | * set plus the result is either -(2^(rsize-1)) or (2^(rsize-1))-1 depending |
650 | * on the sign in such case. |
651 | */ |
652 | #define _FP_TO_INT(fs, wc, r, X, rsize, rsigned) \ |
653 | do { \ |
654 | switch (X##_c) \ |
655 | { \ |
656 | case FP_CLS_NORMAL: \ |
657 | if (X##_e < 0) \ |
658 | { \ |
659 | FP_SET_EXCEPTION(FP_EX_INEXACT); \ |
660 | case FP_CLS_ZERO: \ |
661 | r = 0; \ |
662 | } \ |
663 | else if (X##_e >= rsize - (rsigned > 0 || X##_s) \ |
664 | || (!rsigned && X##_s)) \ |
665 | { /* overflow */ \ |
666 | case FP_CLS_NAN: \ |
667 | case FP_CLS_INF: \ |
668 | if (rsigned == 2) \ |
669 | { \ |
670 | if (X##_c != FP_CLS_NORMAL \ |
671 | || X##_e >= rsize - 1 + _FP_WFRACBITS_##fs) \ |
672 | r = 0; \ |
673 | else \ |
674 | { \ |
675 | _FP_FRAC_SLL_##wc(X, (X##_e - _FP_WFRACBITS_##fs + 1)); \ |
676 | _FP_FRAC_ASSEMBLE_##wc(r, X, rsize); \ |
677 | } \ |
678 | } \ |
679 | else if (rsigned) \ |
680 | { \ |
681 | r = 1; \ |
682 | r <<= rsize - 1; \ |
683 | r -= 1 - X##_s; \ |
684 | } \ |
685 | else \ |
686 | { \ |
687 | r = 0; \ |
688 | if (X##_s) \ |
689 | r = ~r; \ |
690 | } \ |
691 | FP_SET_EXCEPTION(FP_EX_INVALID); \ |
692 | } \ |
693 | else \ |
694 | { \ |
695 | if (_FP_W_TYPE_SIZE*wc < rsize) \ |
696 | { \ |
697 | _FP_FRAC_ASSEMBLE_##wc(r, X, rsize); \ |
698 | r <<= X##_e - _FP_WFRACBITS_##fs; \ |
699 | } \ |
700 | else \ |
701 | { \ |
702 | if (X##_e >= _FP_WFRACBITS_##fs) \ |
703 | _FP_FRAC_SLL_##wc(X, (X##_e - _FP_WFRACBITS_##fs + 1)); \ |
704 | else if (X##_e < _FP_WFRACBITS_##fs - 1) \ |
705 | { \ |
706 | _FP_FRAC_SRS_##wc(X, (_FP_WFRACBITS_##fs - X##_e - 2), \ |
707 | _FP_WFRACBITS_##fs); \ |
708 | if (_FP_FRAC_LOW_##wc(X) & 1) \ |
709 | FP_SET_EXCEPTION(FP_EX_INEXACT); \ |
710 | _FP_FRAC_SRL_##wc(X, 1); \ |
711 | } \ |
712 | _FP_FRAC_ASSEMBLE_##wc(r, X, rsize); \ |
713 | } \ |
714 | if (rsigned && X##_s) \ |
715 | r = -r; \ |
716 | } \ |
717 | break; \ |
718 | } \ |
719 | } while (0) |
720 | |
721 | #define _FP_TO_INT_ROUND(fs, wc, r, X, rsize, rsigned) \ |
722 | do { \ |
723 | r = 0; \ |
724 | switch (X##_c) \ |
725 | { \ |
726 | case FP_CLS_NORMAL: \ |
727 | if (X##_e >= _FP_FRACBITS_##fs - 1) \ |
728 | { \ |
729 | if (X##_e < rsize - 1 + _FP_WFRACBITS_##fs) \ |
730 | { \ |
731 | if (X##_e >= _FP_WFRACBITS_##fs - 1) \ |
732 | { \ |
733 | _FP_FRAC_ASSEMBLE_##wc(r, X, rsize); \ |
734 | r <<= X##_e - _FP_WFRACBITS_##fs + 1; \ |
735 | } \ |
736 | else \ |
737 | { \ |
738 | _FP_FRAC_SRL_##wc(X, _FP_WORKBITS - X##_e \ |
739 | + _FP_FRACBITS_##fs - 1); \ |
740 | _FP_FRAC_ASSEMBLE_##wc(r, X, rsize); \ |
741 | } \ |
742 | } \ |
743 | } \ |
744 | else \ |
745 | { \ |
746 | if (X##_e <= -_FP_WORKBITS - 1) \ |
747 | _FP_FRAC_SET_##wc(X, _FP_MINFRAC_##wc); \ |
748 | else \ |
749 | _FP_FRAC_SRS_##wc(X, _FP_FRACBITS_##fs - 1 - X##_e, \ |
750 | _FP_WFRACBITS_##fs); \ |
751 | _FP_ROUND(wc, X); \ |
752 | _FP_FRAC_SRL_##wc(X, _FP_WORKBITS); \ |
753 | _FP_FRAC_ASSEMBLE_##wc(r, X, rsize); \ |
754 | } \ |
755 | if (rsigned && X##_s) \ |
756 | r = -r; \ |
757 | if (X##_e >= rsize - (rsigned > 0 || X##_s) \ |
758 | || (!rsigned && X##_s)) \ |
759 | { /* overflow */ \ |
760 | case FP_CLS_NAN: \ |
761 | case FP_CLS_INF: \ |
762 | if (!rsigned) \ |
763 | { \ |
764 | r = 0; \ |
765 | if (X##_s) \ |
766 | r = ~r; \ |
767 | } \ |
768 | else if (rsigned != 2) \ |
769 | { \ |
770 | r = 1; \ |
771 | r <<= rsize - 1; \ |
772 | r -= 1 - X##_s; \ |
773 | } \ |
774 | FP_SET_EXCEPTION(FP_EX_INVALID); \ |
775 | } \ |
776 | break; \ |
777 | case FP_CLS_ZERO: \ |
778 | break; \ |
779 | } \ |
780 | } while (0) |
781 | |
782 | #define _FP_FROM_INT(fs, wc, X, r, rsize, rtype) \ |
783 | do { \ |
784 | if (r) \ |
785 | { \ |
786 | unsigned rtype ur_; \ |
787 | X##_c = FP_CLS_NORMAL; \ |
788 | \ |
789 | if ((X##_s = (r < 0))) \ |
790 | ur_ = (unsigned rtype) -r; \ |
791 | else \ |
792 | ur_ = (unsigned rtype) r; \ |
793 | if (rsize <= _FP_W_TYPE_SIZE) \ |
794 | __FP_CLZ(X##_e, ur_); \ |
795 | else \ |
796 | __FP_CLZ_2(X##_e, (_FP_W_TYPE)(ur_ >> _FP_W_TYPE_SIZE), \ |
797 | (_FP_W_TYPE)ur_); \ |
798 | if (rsize < _FP_W_TYPE_SIZE) \ |
799 | X##_e -= (_FP_W_TYPE_SIZE - rsize); \ |
800 | X##_e = rsize - X##_e - 1; \ |
801 | \ |
802 | if (_FP_FRACBITS_##fs < rsize && _FP_WFRACBITS_##fs <= X##_e) \ |
803 | __FP_FRAC_SRS_1(ur_, (X##_e - _FP_WFRACBITS_##fs + 1), rsize);\ |
804 | _FP_FRAC_DISASSEMBLE_##wc(X, ur_, rsize); \ |
805 | if ((_FP_WFRACBITS_##fs - X##_e - 1) > 0) \ |
806 | _FP_FRAC_SLL_##wc(X, (_FP_WFRACBITS_##fs - X##_e - 1)); \ |
807 | } \ |
808 | else \ |
809 | { \ |
810 | X##_c = FP_CLS_ZERO, X##_s = 0; \ |
811 | } \ |
812 | } while (0) |
813 | |
814 | |
815 | #define FP_CONV(dfs,sfs,dwc,swc,D,S) \ |
816 | do { \ |
817 | _FP_FRAC_CONV_##dwc##_##swc(dfs, sfs, D, S); \ |
818 | D##_e = S##_e; \ |
819 | D##_c = S##_c; \ |
820 | D##_s = S##_s; \ |
821 | } while (0) |
822 | |
823 | /* |
824 | * Helper primitives. |
825 | */ |
826 | |
827 | /* Count leading zeros in a word. */ |
828 | |
829 | #ifndef __FP_CLZ |
830 | #if _FP_W_TYPE_SIZE < 64 |
831 | /* this is just to shut the compiler up about shifts > word length -- PMM 02/1998 */ |
832 | #define __FP_CLZ(r, x) \ |
833 | do { \ |
834 | _FP_W_TYPE _t = (x); \ |
835 | r = _FP_W_TYPE_SIZE - 1; \ |
836 | if (_t > 0xffff) r -= 16; \ |
837 | if (_t > 0xffff) _t >>= 16; \ |
838 | if (_t > 0xff) r -= 8; \ |
839 | if (_t > 0xff) _t >>= 8; \ |
840 | if (_t & 0xf0) r -= 4; \ |
841 | if (_t & 0xf0) _t >>= 4; \ |
842 | if (_t & 0xc) r -= 2; \ |
843 | if (_t & 0xc) _t >>= 2; \ |
844 | if (_t & 0x2) r -= 1; \ |
845 | } while (0) |
846 | #else /* not _FP_W_TYPE_SIZE < 64 */ |
847 | #define __FP_CLZ(r, x) \ |
848 | do { \ |
849 | _FP_W_TYPE _t = (x); \ |
850 | r = _FP_W_TYPE_SIZE - 1; \ |
851 | if (_t > 0xffffffff) r -= 32; \ |
852 | if (_t > 0xffffffff) _t >>= 32; \ |
853 | if (_t > 0xffff) r -= 16; \ |
854 | if (_t > 0xffff) _t >>= 16; \ |
855 | if (_t > 0xff) r -= 8; \ |
856 | if (_t > 0xff) _t >>= 8; \ |
857 | if (_t & 0xf0) r -= 4; \ |
858 | if (_t & 0xf0) _t >>= 4; \ |
859 | if (_t & 0xc) r -= 2; \ |
860 | if (_t & 0xc) _t >>= 2; \ |
861 | if (_t & 0x2) r -= 1; \ |
862 | } while (0) |
863 | #endif /* not _FP_W_TYPE_SIZE < 64 */ |
864 | #endif /* ndef __FP_CLZ */ |
865 | |
866 | #define _FP_DIV_HELP_imm(q, r, n, d) \ |
867 | do { \ |
868 | q = n / d, r = n % d; \ |
869 | } while (0) |
870 | |
871 | #endif /* __MATH_EMU_OP_COMMON_H__ */ |
872 |
Branches:
ben-wpan
ben-wpan-stefan
javiroman/ks7010
jz-2.6.34
jz-2.6.34-rc5
jz-2.6.34-rc6
jz-2.6.34-rc7
jz-2.6.35
jz-2.6.36
jz-2.6.37
jz-2.6.38
jz-2.6.39
jz-3.0
jz-3.1
jz-3.11
jz-3.12
jz-3.13
jz-3.15
jz-3.16
jz-3.18-dt
jz-3.2
jz-3.3
jz-3.4
jz-3.5
jz-3.6
jz-3.6-rc2-pwm
jz-3.9
jz-3.9-clk
jz-3.9-rc8
jz47xx
jz47xx-2.6.38
master
Tags:
od-2011-09-04
od-2011-09-18
v2.6.34-rc5
v2.6.34-rc6
v2.6.34-rc7
v3.9