glsl: Add "built-in" functions to do trunc(fp64)
[mesa.git] / src / compiler / glsl / float64.glsl
1 /*
2 * The implementations contained in this file are heavily based on the
3 * implementations found in the Berkeley SoftFloat library. As such, they are
4 * licensed under the same 3-clause BSD license:
5 *
6 * License for Berkeley SoftFloat Release 3e
7 *
8 * John R. Hauser
9 * 2018 January 20
10 *
11 * The following applies to the whole of SoftFloat Release 3e as well as to
12 * each source file individually.
13 *
14 * Copyright 2011, 2012, 2013, 2014, 2015, 2016, 2017, 2018 The Regents of the
15 * University of California. All rights reserved.
16 *
17 * Redistribution and use in source and binary forms, with or without
18 * modification, are permitted provided that the following conditions are met:
19 *
20 * 1. Redistributions of source code must retain the above copyright notice,
21 * this list of conditions, and the following disclaimer.
22 *
23 * 2. Redistributions in binary form must reproduce the above copyright
24 * notice, this list of conditions, and the following disclaimer in the
25 * documentation and/or other materials provided with the distribution.
26 *
27 * 3. Neither the name of the University nor the names of its contributors
28 * may be used to endorse or promote products derived from this software
29 * without specific prior written permission.
30 *
31 * THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS "AS IS", AND ANY
32 * EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED
33 * WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE, ARE
34 * DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE FOR ANY
35 * DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
36 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES;
37 * LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND
38 * ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT
39 * (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF
40 * THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
41 */
42
43 #version 430
44 #extension GL_ARB_gpu_shader_int64 : enable
45 #extension GL_ARB_shader_bit_encoding : enable
46 #extension GL_EXT_shader_integer_mix : enable
47 #extension GL_MESA_shader_integer_functions : enable
48
49 #pragma warning(off)
50
51 /* Software IEEE floating-point rounding mode.
52 * GLSL spec section "4.7.1 Range and Precision":
53 * The rounding mode cannot be set and is undefined.
54 * But here, we are able to define the rounding mode at the compilation time.
55 */
56 #define FLOAT_ROUND_NEAREST_EVEN 0
57 #define FLOAT_ROUND_TO_ZERO 1
58 #define FLOAT_ROUND_DOWN 2
59 #define FLOAT_ROUND_UP 3
60 #define FLOAT_ROUNDING_MODE FLOAT_ROUND_NEAREST_EVEN
61
62 /* Absolute value of a Float64 :
63 * Clear the sign bit
64 */
65 uint64_t
66 __fabs64(uint64_t __a)
67 {
68 uvec2 a = unpackUint2x32(__a);
69 a.y &= 0x7FFFFFFFu;
70 return packUint2x32(a);
71 }
72
73 /* Returns 1 if the double-precision floating-point value `a' is a NaN;
74 * otherwise returns 0.
75 */
76 bool
77 __is_nan(uint64_t __a)
78 {
79 uvec2 a = unpackUint2x32(__a);
80 return (0xFFE00000u <= (a.y<<1)) &&
81 ((a.x != 0u) || ((a.y & 0x000FFFFFu) != 0u));
82 }
83
84 /* Negate value of a Float64 :
85 * Toggle the sign bit
86 */
87 uint64_t
88 __fneg64(uint64_t __a)
89 {
90 uvec2 a = unpackUint2x32(__a);
91 uint t = a.y;
92
93 t ^= (1u << 31);
94 a.y = mix(t, a.y, __is_nan(__a));
95 return packUint2x32(a);
96 }
97
98 uint64_t
99 __fsign64(uint64_t __a)
100 {
101 uvec2 a = unpackUint2x32(__a);
102 uvec2 retval;
103 retval.x = 0u;
104 retval.y = mix((a.y & 0x80000000u) | 0x3FF00000u, 0u, (a.y << 1 | a.x) == 0u);
105 return packUint2x32(retval);
106 }
107
108 /* Returns the fraction bits of the double-precision floating-point value `a'.*/
109 uint
110 __extractFloat64FracLo(uint64_t a)
111 {
112 return unpackUint2x32(a).x;
113 }
114
115 uint
116 __extractFloat64FracHi(uint64_t a)
117 {
118 return unpackUint2x32(a).y & 0x000FFFFFu;
119 }
120
121 /* Returns the exponent bits of the double-precision floating-point value `a'.*/
122 int
123 __extractFloat64Exp(uint64_t __a)
124 {
125 uvec2 a = unpackUint2x32(__a);
126 return int((a.y>>20) & 0x7FFu);
127 }
128
129 bool
130 __feq64_nonnan(uint64_t __a, uint64_t __b)
131 {
132 uvec2 a = unpackUint2x32(__a);
133 uvec2 b = unpackUint2x32(__b);
134 return (a.x == b.x) &&
135 ((a.y == b.y) || ((a.x == 0u) && (((a.y | b.y)<<1) == 0u)));
136 }
137
138 /* Returns true if the double-precision floating-point value `a' is equal to the
139 * corresponding value `b', and false otherwise. The comparison is performed
140 * according to the IEEE Standard for Floating-Point Arithmetic.
141 */
142 bool
143 __feq64(uint64_t a, uint64_t b)
144 {
145 if (__is_nan(a) || __is_nan(b))
146 return false;
147
148 return __feq64_nonnan(a, b);
149 }
150
151 /* Returns true if the double-precision floating-point value `a' is not equal
152 * to the corresponding value `b', and false otherwise. The comparison is
153 * performed according to the IEEE Standard for Floating-Point Arithmetic.
154 */
155 bool
156 __fne64(uint64_t a, uint64_t b)
157 {
158 if (__is_nan(a) || __is_nan(b))
159 return true;
160
161 return !__feq64_nonnan(a, b);
162 }
163
164 /* Returns the sign bit of the double-precision floating-point value `a'.*/
165 uint
166 __extractFloat64Sign(uint64_t a)
167 {
168 return unpackUint2x32(a).y >> 31;
169 }
170
171 /* Returns true if the 64-bit value formed by concatenating `a0' and `a1' is less
172 * than the 64-bit value formed by concatenating `b0' and `b1'. Otherwise,
173 * returns false.
174 */
175 bool
176 lt64(uint a0, uint a1, uint b0, uint b1)
177 {
178 return (a0 < b0) || ((a0 == b0) && (a1 < b1));
179 }
180
181 bool
182 __flt64_nonnan(uint64_t __a, uint64_t __b)
183 {
184 uvec2 a = unpackUint2x32(__a);
185 uvec2 b = unpackUint2x32(__b);
186 uint aSign = __extractFloat64Sign(__a);
187 uint bSign = __extractFloat64Sign(__b);
188 if (aSign != bSign)
189 return (aSign != 0u) && ((((a.y | b.y)<<1) | a.x | b.x) != 0u);
190
191 return mix(lt64(a.y, a.x, b.y, b.x), lt64(b.y, b.x, a.y, a.x), aSign != 0u);
192 }
193
194 /* Returns true if the double-precision floating-point value `a' is less than
195 * the corresponding value `b', and false otherwise. The comparison is performed
196 * according to the IEEE Standard for Floating-Point Arithmetic.
197 */
198 bool
199 __flt64(uint64_t a, uint64_t b)
200 {
201 if (__is_nan(a) || __is_nan(b))
202 return false;
203
204 return __flt64_nonnan(a, b);
205 }
206
207 /* Returns true if the double-precision floating-point value `a' is greater
208 * than or equal to * the corresponding value `b', and false otherwise. The
209 * comparison is performed * according to the IEEE Standard for Floating-Point
210 * Arithmetic.
211 */
212 bool
213 __fge64(uint64_t a, uint64_t b)
214 {
215 if (__is_nan(a) || __is_nan(b))
216 return false;
217
218 return !__flt64_nonnan(a, b);
219 }
220
221 /* Adds the 64-bit value formed by concatenating `a0' and `a1' to the 64-bit
222 * value formed by concatenating `b0' and `b1'. Addition is modulo 2^64, so
223 * any carry out is lost. The result is broken into two 32-bit pieces which
224 * are stored at the locations pointed to by `z0Ptr' and `z1Ptr'.
225 */
226 void
227 __add64(uint a0, uint a1, uint b0, uint b1,
228 out uint z0Ptr,
229 out uint z1Ptr)
230 {
231 uint z1 = a1 + b1;
232 z1Ptr = z1;
233 z0Ptr = a0 + b0 + uint(z1 < a1);
234 }
235
236
237 /* Subtracts the 64-bit value formed by concatenating `b0' and `b1' from the
238 * 64-bit value formed by concatenating `a0' and `a1'. Subtraction is modulo
239 * 2^64, so any borrow out (carry out) is lost. The result is broken into two
240 * 32-bit pieces which are stored at the locations pointed to by `z0Ptr' and
241 * `z1Ptr'.
242 */
243 void
244 __sub64(uint a0, uint a1, uint b0, uint b1,
245 out uint z0Ptr,
246 out uint z1Ptr)
247 {
248 z1Ptr = a1 - b1;
249 z0Ptr = a0 - b0 - uint(a1 < b1);
250 }
251
252 /* Shifts the 64-bit value formed by concatenating `a0' and `a1' right by the
253 * number of bits given in `count'. If any nonzero bits are shifted off, they
254 * are "jammed" into the least significant bit of the result by setting the
255 * least significant bit to 1. The value of `count' can be arbitrarily large;
256 * in particular, if `count' is greater than 64, the result will be either 0
257 * or 1, depending on whether the concatenation of `a0' and `a1' is zero or
258 * nonzero. The result is broken into two 32-bit pieces which are stored at
259 * the locations pointed to by `z0Ptr' and `z1Ptr'.
260 */
261 void
262 __shift64RightJamming(uint a0,
263 uint a1,
264 int count,
265 out uint z0Ptr,
266 out uint z1Ptr)
267 {
268 uint z0;
269 uint z1;
270 int negCount = (-count) & 31;
271
272 z0 = mix(0u, a0, count == 0);
273 z0 = mix(z0, (a0 >> count), count < 32);
274
275 z1 = uint((a0 | a1) != 0u); /* count >= 64 */
276 uint z1_lt64 = (a0>>(count & 31)) | uint(((a0<<negCount) | a1) != 0u);
277 z1 = mix(z1, z1_lt64, count < 64);
278 z1 = mix(z1, (a0 | uint(a1 != 0u)), count == 32);
279 uint z1_lt32 = (a0<<negCount) | (a1>>count) | uint ((a1<<negCount) != 0u);
280 z1 = mix(z1, z1_lt32, count < 32);
281 z1 = mix(z1, a1, count == 0);
282 z1Ptr = z1;
283 z0Ptr = z0;
284 }
285
286 /* Shifts the 96-bit value formed by concatenating `a0', `a1', and `a2' right
287 * by 32 _plus_ the number of bits given in `count'. The shifted result is
288 * at most 64 nonzero bits; these are broken into two 32-bit pieces which are
289 * stored at the locations pointed to by `z0Ptr' and `z1Ptr'. The bits shifted
290 * off form a third 32-bit result as follows: The _last_ bit shifted off is
291 * the most-significant bit of the extra result, and the other 31 bits of the
292 * extra result are all zero if and only if _all_but_the_last_ bits shifted off
293 * were all zero. This extra result is stored in the location pointed to by
294 * `z2Ptr'. The value of `count' can be arbitrarily large.
295 * (This routine makes more sense if `a0', `a1', and `a2' are considered
296 * to form a fixed-point value with binary point between `a1' and `a2'. This
297 * fixed-point value is shifted right by the number of bits given in `count',
298 * and the integer part of the result is returned at the locations pointed to
299 * by `z0Ptr' and `z1Ptr'. The fractional part of the result may be slightly
300 * corrupted as described above, and is returned at the location pointed to by
301 * `z2Ptr'.)
302 */
303 void
304 __shift64ExtraRightJamming(uint a0, uint a1, uint a2,
305 int count,
306 out uint z0Ptr,
307 out uint z1Ptr,
308 out uint z2Ptr)
309 {
310 uint z0 = 0u;
311 uint z1;
312 uint z2;
313 int negCount = (-count) & 31;
314
315 z2 = mix(uint(a0 != 0u), a0, count == 64);
316 z2 = mix(z2, a0 << negCount, count < 64);
317 z2 = mix(z2, a1 << negCount, count < 32);
318
319 z1 = mix(0u, (a0 >> (count & 31)), count < 64);
320 z1 = mix(z1, (a0<<negCount) | (a1>>count), count < 32);
321
322 a2 = mix(a2 | a1, a2, count < 32);
323 z0 = mix(z0, a0 >> count, count < 32);
324 z2 |= uint(a2 != 0u);
325
326 z0 = mix(z0, 0u, (count == 32));
327 z1 = mix(z1, a0, (count == 32));
328 z2 = mix(z2, a1, (count == 32));
329 z0 = mix(z0, a0, (count == 0));
330 z1 = mix(z1, a1, (count == 0));
331 z2 = mix(z2, a2, (count == 0));
332 z2Ptr = z2;
333 z1Ptr = z1;
334 z0Ptr = z0;
335 }
336
337 /* Shifts the 64-bit value formed by concatenating `a0' and `a1' left by the
338 * number of bits given in `count'. Any bits shifted off are lost. The value
339 * of `count' must be less than 32. The result is broken into two 32-bit
340 * pieces which are stored at the locations pointed to by `z0Ptr' and `z1Ptr'.
341 */
342 void
343 __shortShift64Left(uint a0, uint a1,
344 int count,
345 out uint z0Ptr,
346 out uint z1Ptr)
347 {
348 z1Ptr = a1<<count;
349 z0Ptr = mix((a0 << count | (a1 >> ((-count) & 31))), a0, count == 0);
350 }
351
352 /* Packs the sign `zSign', the exponent `zExp', and the significand formed by
353 * the concatenation of `zFrac0' and `zFrac1' into a double-precision floating-
354 * point value, returning the result. After being shifted into the proper
355 * positions, the three fields `zSign', `zExp', and `zFrac0' are simply added
356 * together to form the most significant 32 bits of the result. This means
357 * that any integer portion of `zFrac0' will be added into the exponent. Since
358 * a properly normalized significand will have an integer portion equal to 1,
359 * the `zExp' input should be 1 less than the desired result exponent whenever
360 * `zFrac0' and `zFrac1' concatenated form a complete, normalized significand.
361 */
362 uint64_t
363 __packFloat64(uint zSign, int zExp, uint zFrac0, uint zFrac1)
364 {
365 uvec2 z;
366
367 z.y = (zSign << 31) + (uint(zExp) << 20) + zFrac0;
368 z.x = zFrac1;
369 return packUint2x32(z);
370 }
371
372 /* Takes an abstract floating-point value having sign `zSign', exponent `zExp',
373 * and extended significand formed by the concatenation of `zFrac0', `zFrac1',
374 * and `zFrac2', and returns the proper double-precision floating-point value
375 * corresponding to the abstract input. Ordinarily, the abstract value is
376 * simply rounded and packed into the double-precision format, with the inexact
377 * exception raised if the abstract input cannot be represented exactly.
378 * However, if the abstract value is too large, the overflow and inexact
379 * exceptions are raised and an infinity or maximal finite value is returned.
380 * If the abstract value is too small, the input value is rounded to a
381 * subnormal number, and the underflow and inexact exceptions are raised if the
382 * abstract input cannot be represented exactly as a subnormal double-precision
383 * floating-point number.
384 * The input significand must be normalized or smaller. If the input
385 * significand is not normalized, `zExp' must be 0; in that case, the result
386 * returned is a subnormal number, and it must not require rounding. In the
387 * usual case that the input significand is normalized, `zExp' must be 1 less
388 * than the "true" floating-point exponent. The handling of underflow and
389 * overflow follows the IEEE Standard for Floating-Point Arithmetic.
390 */
391 uint64_t
392 __roundAndPackFloat64(uint zSign,
393 int zExp,
394 uint zFrac0,
395 uint zFrac1,
396 uint zFrac2)
397 {
398 bool roundNearestEven;
399 bool increment;
400
401 roundNearestEven = FLOAT_ROUNDING_MODE == FLOAT_ROUND_NEAREST_EVEN;
402 increment = int(zFrac2) < 0;
403 if (!roundNearestEven) {
404 if (FLOAT_ROUNDING_MODE == FLOAT_ROUND_TO_ZERO) {
405 increment = false;
406 } else {
407 if (zSign != 0u) {
408 increment = (FLOAT_ROUNDING_MODE == FLOAT_ROUND_DOWN) &&
409 (zFrac2 != 0u);
410 } else {
411 increment = (FLOAT_ROUNDING_MODE == FLOAT_ROUND_UP) &&
412 (zFrac2 != 0u);
413 }
414 }
415 }
416 if (0x7FD <= zExp) {
417 if ((0x7FD < zExp) ||
418 ((zExp == 0x7FD) &&
419 (0x001FFFFFu == zFrac0 && 0xFFFFFFFFu == zFrac1) &&
420 increment)) {
421 if ((FLOAT_ROUNDING_MODE == FLOAT_ROUND_TO_ZERO) ||
422 ((zSign != 0u) && (FLOAT_ROUNDING_MODE == FLOAT_ROUND_UP)) ||
423 ((zSign == 0u) && (FLOAT_ROUNDING_MODE == FLOAT_ROUND_DOWN))) {
424 return __packFloat64(zSign, 0x7FE, 0x000FFFFFu, 0xFFFFFFFFu);
425 }
426 return __packFloat64(zSign, 0x7FF, 0u, 0u);
427 }
428 if (zExp < 0) {
429 __shift64ExtraRightJamming(
430 zFrac0, zFrac1, zFrac2, -zExp, zFrac0, zFrac1, zFrac2);
431 zExp = 0;
432 if (roundNearestEven) {
433 increment = zFrac2 < 0u;
434 } else {
435 if (zSign != 0u) {
436 increment = (FLOAT_ROUNDING_MODE == FLOAT_ROUND_DOWN) &&
437 (zFrac2 != 0u);
438 } else {
439 increment = (FLOAT_ROUNDING_MODE == FLOAT_ROUND_UP) &&
440 (zFrac2 != 0u);
441 }
442 }
443 }
444 }
445 if (increment) {
446 __add64(zFrac0, zFrac1, 0u, 1u, zFrac0, zFrac1);
447 zFrac1 &= ~((zFrac2 + uint(zFrac2 == 0u)) & uint(roundNearestEven));
448 } else {
449 zExp = mix(zExp, 0, (zFrac0 | zFrac1) == 0u);
450 }
451 return __packFloat64(zSign, zExp, zFrac0, zFrac1);
452 }
453
454 /* Returns the number of leading 0 bits before the most-significant 1 bit of
455 * `a'. If `a' is zero, 32 is returned.
456 */
457 int
458 __countLeadingZeros32(uint a)
459 {
460 int shiftCount;
461 shiftCount = mix(31 - findMSB(a), 32, a == 0u);
462 return shiftCount;
463 }
464
465 /* Takes an abstract floating-point value having sign `zSign', exponent `zExp',
466 * and significand formed by the concatenation of `zSig0' and `zSig1', and
467 * returns the proper double-precision floating-point value corresponding
468 * to the abstract input. This routine is just like `__roundAndPackFloat64'
469 * except that the input significand has fewer bits and does not have to be
470 * normalized. In all cases, `zExp' must be 1 less than the "true" floating-
471 * point exponent.
472 */
473 uint64_t
474 __normalizeRoundAndPackFloat64(uint zSign,
475 int zExp,
476 uint zFrac0,
477 uint zFrac1)
478 {
479 int shiftCount;
480 uint zFrac2;
481
482 if (zFrac0 == 0u) {
483 zExp -= 32;
484 zFrac0 = zFrac1;
485 zFrac1 = 0u;
486 }
487
488 shiftCount = __countLeadingZeros32(zFrac0) - 11;
489 if (0 <= shiftCount) {
490 zFrac2 = 0u;
491 __shortShift64Left(zFrac0, zFrac1, shiftCount, zFrac0, zFrac1);
492 } else {
493 __shift64ExtraRightJamming(
494 zFrac0, zFrac1, 0u, -shiftCount, zFrac0, zFrac1, zFrac2);
495 }
496 zExp -= shiftCount;
497 return __roundAndPackFloat64(zSign, zExp, zFrac0, zFrac1, zFrac2);
498 }
499
500 /* Takes two double-precision floating-point values `a' and `b', one of which
501 * is a NaN, and returns the appropriate NaN result.
502 */
503 uint64_t
504 __propagateFloat64NaN(uint64_t __a, uint64_t __b)
505 {
506 bool aIsNaN = __is_nan(__a);
507 bool bIsNaN = __is_nan(__b);
508 uvec2 a = unpackUint2x32(__a);
509 uvec2 b = unpackUint2x32(__b);
510 a.y |= 0x00080000u;
511 b.y |= 0x00080000u;
512
513 return packUint2x32(mix(b, mix(a, b, bvec2(bIsNaN, bIsNaN)), bvec2(aIsNaN, aIsNaN)));
514 }
515
516 /* Returns the result of adding the double-precision floating-point values
517 * `a' and `b'. The operation is performed according to the IEEE Standard for
518 * Floating-Point Arithmetic.
519 */
520 uint64_t
521 __fadd64(uint64_t a, uint64_t b)
522 {
523 uint aSign = __extractFloat64Sign(a);
524 uint bSign = __extractFloat64Sign(b);
525 uint aFracLo = __extractFloat64FracLo(a);
526 uint aFracHi = __extractFloat64FracHi(a);
527 uint bFracLo = __extractFloat64FracLo(b);
528 uint bFracHi = __extractFloat64FracHi(b);
529 int aExp = __extractFloat64Exp(a);
530 int bExp = __extractFloat64Exp(b);
531 uint zFrac0 = 0u;
532 uint zFrac1 = 0u;
533 int expDiff = aExp - bExp;
534 if (aSign == bSign) {
535 uint zFrac2 = 0u;
536 int zExp;
537 bool orig_exp_diff_is_zero = (expDiff == 0);
538
539 if (orig_exp_diff_is_zero) {
540 if (aExp == 0x7FF) {
541 bool propagate = (aFracHi | aFracLo | bFracHi | bFracLo) != 0u;
542 return mix(a, __propagateFloat64NaN(a, b), propagate);
543 }
544 __add64(aFracHi, aFracLo, bFracHi, bFracLo, zFrac0, zFrac1);
545 if (aExp == 0)
546 return __packFloat64(aSign, 0, zFrac0, zFrac1);
547 zFrac2 = 0u;
548 zFrac0 |= 0x00200000u;
549 zExp = aExp;
550 __shift64ExtraRightJamming(
551 zFrac0, zFrac1, zFrac2, 1, zFrac0, zFrac1, zFrac2);
552 } else if (0 < expDiff) {
553 if (aExp == 0x7FF) {
554 bool propagate = (aFracHi | aFracLo) != 0u;
555 return mix(a, __propagateFloat64NaN(a, b), propagate);
556 }
557
558 expDiff = mix(expDiff, expDiff - 1, bExp == 0);
559 bFracHi = mix(bFracHi | 0x00100000u, bFracHi, bExp == 0);
560 __shift64ExtraRightJamming(
561 bFracHi, bFracLo, 0u, expDiff, bFracHi, bFracLo, zFrac2);
562 zExp = aExp;
563 } else if (expDiff < 0) {
564 if (bExp == 0x7FF) {
565 bool propagate = (bFracHi | bFracLo) != 0u;
566 return mix(__packFloat64(aSign, 0x7ff, 0u, 0u), __propagateFloat64NaN(a, b), propagate);
567 }
568 expDiff = mix(expDiff, expDiff + 1, aExp == 0);
569 aFracHi = mix(aFracHi | 0x00100000u, aFracHi, aExp == 0);
570 __shift64ExtraRightJamming(
571 aFracHi, aFracLo, 0u, - expDiff, aFracHi, aFracLo, zFrac2);
572 zExp = bExp;
573 }
574 if (!orig_exp_diff_is_zero) {
575 aFracHi |= 0x00100000u;
576 __add64(aFracHi, aFracLo, bFracHi, bFracLo, zFrac0, zFrac1);
577 --zExp;
578 if (!(zFrac0 < 0x00200000u)) {
579 __shift64ExtraRightJamming(zFrac0, zFrac1, zFrac2, 1, zFrac0, zFrac1, zFrac2);
580 ++zExp;
581 }
582 }
583 return __roundAndPackFloat64(aSign, zExp, zFrac0, zFrac1, zFrac2);
584
585 } else {
586 int zExp;
587
588 __shortShift64Left(aFracHi, aFracLo, 10, aFracHi, aFracLo);
589 __shortShift64Left(bFracHi, bFracLo, 10, bFracHi, bFracLo);
590 if (0 < expDiff) {
591 if (aExp == 0x7FF) {
592 bool propagate = (aFracHi | aFracLo) != 0u;
593 return mix(a, __propagateFloat64NaN(a, b), propagate);
594 }
595 expDiff = mix(expDiff, expDiff - 1, bExp == 0);
596 bFracHi = mix(bFracHi | 0x40000000u, bFracHi, bExp == 0);
597 __shift64RightJamming(bFracHi, bFracLo, expDiff, bFracHi, bFracLo);
598 aFracHi |= 0x40000000u;
599 __sub64(aFracHi, aFracLo, bFracHi, bFracLo, zFrac0, zFrac1);
600 zExp = aExp;
601 --zExp;
602 return __normalizeRoundAndPackFloat64(aSign, zExp - 10, zFrac0, zFrac1);
603 }
604 if (expDiff < 0) {
605 if (bExp == 0x7FF) {
606 bool propagate = (bFracHi | bFracLo) != 0u;
607 return mix(__packFloat64(aSign ^ 1u, 0x7ff, 0u, 0u), __propagateFloat64NaN(a, b), propagate);
608 }
609 expDiff = mix(expDiff, expDiff + 1, aExp == 0);
610 aFracHi = mix(aFracHi | 0x40000000u, aFracHi, aExp == 0);
611 __shift64RightJamming(aFracHi, aFracLo, - expDiff, aFracHi, aFracLo);
612 bFracHi |= 0x40000000u;
613 __sub64(bFracHi, bFracLo, aFracHi, aFracLo, zFrac0, zFrac1);
614 zExp = bExp;
615 aSign ^= 1u;
616 --zExp;
617 return __normalizeRoundAndPackFloat64(aSign, zExp - 10, zFrac0, zFrac1);
618 }
619 if (aExp == 0x7FF) {
620 bool propagate = (aFracHi | aFracLo | bFracHi | bFracLo) != 0u;
621 return mix(0xFFFFFFFFFFFFFFFFUL, __propagateFloat64NaN(a, b), propagate);
622 }
623 bExp = mix(bExp, 1, aExp == 0);
624 aExp = mix(aExp, 1, aExp == 0);
625 bool zexp_normal = false;
626 bool blta = true;
627 if (bFracHi < aFracHi) {
628 __sub64(aFracHi, aFracLo, bFracHi, bFracLo, zFrac0, zFrac1);
629 zexp_normal = true;
630 }
631 else if (aFracHi < bFracHi) {
632 __sub64(bFracHi, bFracLo, aFracHi, aFracLo, zFrac0, zFrac1);
633 blta = false;
634 zexp_normal = true;
635 }
636 else if (bFracLo < aFracLo) {
637 __sub64(aFracHi, aFracLo, bFracHi, bFracLo, zFrac0, zFrac1);
638 zexp_normal = true;
639 }
640 else if (aFracLo < bFracLo) {
641 __sub64(bFracHi, bFracLo, aFracHi, aFracLo, zFrac0, zFrac1);
642 blta = false;
643 zexp_normal = true;
644 }
645 zExp = mix(bExp, aExp, blta);
646 aSign = mix(aSign ^ 1u, aSign, blta);
647 uint64_t retval_0 = __packFloat64(uint(FLOAT_ROUNDING_MODE == FLOAT_ROUND_DOWN), 0, 0u, 0u);
648 uint64_t retval_1 = __normalizeRoundAndPackFloat64(aSign, zExp - 11, zFrac0, zFrac1);
649 return mix(retval_0, retval_1, zexp_normal);
650 }
651 }
652
653 /* Multiplies `a' by `b' to obtain a 64-bit product. The product is broken
654 * into two 32-bit pieces which are stored at the locations pointed to by
655 * `z0Ptr' and `z1Ptr'.
656 */
657 void
658 __mul32To64(uint a, uint b, out uint z0Ptr, out uint z1Ptr)
659 {
660 uint aLow = a & 0x0000FFFFu;
661 uint aHigh = a>>16;
662 uint bLow = b & 0x0000FFFFu;
663 uint bHigh = b>>16;
664 uint z1 = aLow * bLow;
665 uint zMiddleA = aLow * bHigh;
666 uint zMiddleB = aHigh * bLow;
667 uint z0 = aHigh * bHigh;
668 zMiddleA += zMiddleB;
669 z0 += ((uint(zMiddleA < zMiddleB)) << 16) + (zMiddleA >> 16);
670 zMiddleA <<= 16;
671 z1 += zMiddleA;
672 z0 += uint(z1 < zMiddleA);
673 z1Ptr = z1;
674 z0Ptr = z0;
675 }
676
677 /* Multiplies the 64-bit value formed by concatenating `a0' and `a1' to the
678 * 64-bit value formed by concatenating `b0' and `b1' to obtain a 128-bit
679 * product. The product is broken into four 32-bit pieces which are stored at
680 * the locations pointed to by `z0Ptr', `z1Ptr', `z2Ptr', and `z3Ptr'.
681 */
682 void
683 __mul64To128(uint a0, uint a1, uint b0, uint b1,
684 out uint z0Ptr,
685 out uint z1Ptr,
686 out uint z2Ptr,
687 out uint z3Ptr)
688 {
689 uint z0 = 0u;
690 uint z1 = 0u;
691 uint z2 = 0u;
692 uint z3 = 0u;
693 uint more1 = 0u;
694 uint more2 = 0u;
695
696 __mul32To64(a1, b1, z2, z3);
697 __mul32To64(a1, b0, z1, more2);
698 __add64(z1, more2, 0u, z2, z1, z2);
699 __mul32To64(a0, b0, z0, more1);
700 __add64(z0, more1, 0u, z1, z0, z1);
701 __mul32To64(a0, b1, more1, more2);
702 __add64(more1, more2, 0u, z2, more1, z2);
703 __add64(z0, z1, 0u, more1, z0, z1);
704 z3Ptr = z3;
705 z2Ptr = z2;
706 z1Ptr = z1;
707 z0Ptr = z0;
708 }
709
710 /* Normalizes the subnormal double-precision floating-point value represented
711 * by the denormalized significand formed by the concatenation of `aFrac0' and
712 * `aFrac1'. The normalized exponent is stored at the location pointed to by
713 * `zExpPtr'. The most significant 21 bits of the normalized significand are
714 * stored at the location pointed to by `zFrac0Ptr', and the least significant
715 * 32 bits of the normalized significand are stored at the location pointed to
716 * by `zFrac1Ptr'.
717 */
718 void
719 __normalizeFloat64Subnormal(uint aFrac0, uint aFrac1,
720 out int zExpPtr,
721 out uint zFrac0Ptr,
722 out uint zFrac1Ptr)
723 {
724 int shiftCount;
725 uint temp_zfrac0, temp_zfrac1;
726 shiftCount = __countLeadingZeros32(mix(aFrac0, aFrac1, aFrac0 == 0u)) - 11;
727 zExpPtr = mix(1 - shiftCount, -shiftCount - 31, aFrac0 == 0u);
728
729 temp_zfrac0 = mix(aFrac1<<shiftCount, aFrac1>>(-shiftCount), shiftCount < 0);
730 temp_zfrac1 = mix(0u, aFrac1<<(shiftCount & 31), shiftCount < 0);
731
732 __shortShift64Left(aFrac0, aFrac1, shiftCount, zFrac0Ptr, zFrac1Ptr);
733
734 zFrac0Ptr = mix(zFrac0Ptr, temp_zfrac0, aFrac0 == 0);
735 zFrac1Ptr = mix(zFrac1Ptr, temp_zfrac1, aFrac0 == 0);
736 }
737
738 /* Returns the result of multiplying the double-precision floating-point values
739 * `a' and `b'. The operation is performed according to the IEEE Standard for
740 * Floating-Point Arithmetic.
741 */
742 uint64_t
743 __fmul64(uint64_t a, uint64_t b)
744 {
745 uint zFrac0 = 0u;
746 uint zFrac1 = 0u;
747 uint zFrac2 = 0u;
748 uint zFrac3 = 0u;
749 int zExp;
750
751 uint aFracLo = __extractFloat64FracLo(a);
752 uint aFracHi = __extractFloat64FracHi(a);
753 uint bFracLo = __extractFloat64FracLo(b);
754 uint bFracHi = __extractFloat64FracHi(b);
755 int aExp = __extractFloat64Exp(a);
756 uint aSign = __extractFloat64Sign(a);
757 int bExp = __extractFloat64Exp(b);
758 uint bSign = __extractFloat64Sign(b);
759 uint zSign = aSign ^ bSign;
760 if (aExp == 0x7FF) {
761 if (((aFracHi | aFracLo) != 0u) ||
762 ((bExp == 0x7FF) && ((bFracHi | bFracLo) != 0u))) {
763 return __propagateFloat64NaN(a, b);
764 }
765 if ((uint(bExp) | bFracHi | bFracLo) == 0u)
766 return 0xFFFFFFFFFFFFFFFFUL;
767 return __packFloat64(zSign, 0x7FF, 0u, 0u);
768 }
769 if (bExp == 0x7FF) {
770 if ((bFracHi | bFracLo) != 0u)
771 return __propagateFloat64NaN(a, b);
772 if ((uint(aExp) | aFracHi | aFracLo) == 0u)
773 return 0xFFFFFFFFFFFFFFFFUL;
774 return __packFloat64(zSign, 0x7FF, 0u, 0u);
775 }
776 if (aExp == 0) {
777 if ((aFracHi | aFracLo) == 0u)
778 return __packFloat64(zSign, 0, 0u, 0u);
779 __normalizeFloat64Subnormal(aFracHi, aFracLo, aExp, aFracHi, aFracLo);
780 }
781 if (bExp == 0) {
782 if ((bFracHi | bFracLo) == 0u)
783 return __packFloat64(zSign, 0, 0u, 0u);
784 __normalizeFloat64Subnormal(bFracHi, bFracLo, bExp, bFracHi, bFracLo);
785 }
786 zExp = aExp + bExp - 0x400;
787 aFracHi |= 0x00100000u;
788 __shortShift64Left(bFracHi, bFracLo, 12, bFracHi, bFracLo);
789 __mul64To128(
790 aFracHi, aFracLo, bFracHi, bFracLo, zFrac0, zFrac1, zFrac2, zFrac3);
791 __add64(zFrac0, zFrac1, aFracHi, aFracLo, zFrac0, zFrac1);
792 zFrac2 |= uint(zFrac3 != 0u);
793 if (0x00200000u <= zFrac0) {
794 __shift64ExtraRightJamming(
795 zFrac0, zFrac1, zFrac2, 1, zFrac0, zFrac1, zFrac2);
796 ++zExp;
797 }
798 return __roundAndPackFloat64(zSign, zExp, zFrac0, zFrac1, zFrac2);
799 }
800
801 /* Shifts the 64-bit value formed by concatenating `a0' and `a1' right by the
802 * number of bits given in `count'. Any bits shifted off are lost. The value
803 * of `count' can be arbitrarily large; in particular, if `count' is greater
804 * than 64, the result will be 0. The result is broken into two 32-bit pieces
805 * which are stored at the locations pointed to by `z0Ptr' and `z1Ptr'.
806 */
807 void
808 __shift64Right(uint a0, uint a1,
809 int count,
810 out uint z0Ptr,
811 out uint z1Ptr)
812 {
813 uint z0;
814 uint z1;
815 int negCount = (-count) & 31;
816
817 z0 = 0u;
818 z0 = mix(z0, (a0 >> count), count < 32);
819 z0 = mix(z0, a0, count == 0);
820
821 z1 = mix(0u, (a0 >> (count & 31)), count < 64);
822 z1 = mix(z1, (a0<<negCount) | (a1>>count), count < 32);
823 z1 = mix(z1, a0, count == 0);
824
825 z1Ptr = z1;
826 z0Ptr = z0;
827 }
828
829 /* Returns the result of converting the double-precision floating-point value
830 * `a' to the unsigned integer format. The conversion is performed according
831 * to the IEEE Standard for Floating-Point Arithmetic.
832 */
833 uint
834 __fp64_to_uint(uint64_t a)
835 {
836 uint aFracLo = __extractFloat64FracLo(a);
837 uint aFracHi = __extractFloat64FracHi(a);
838 int aExp = __extractFloat64Exp(a);
839 uint aSign = __extractFloat64Sign(a);
840
841 if ((aExp == 0x7FF) && ((aFracHi | aFracLo) != 0u))
842 return 0xFFFFFFFFu;
843
844 aFracHi |= mix(0u, 0x00100000u, aExp != 0);
845
846 int shiftDist = 0x427 - aExp;
847 if (0 < shiftDist)
848 __shift64RightJamming(aFracHi, aFracLo, shiftDist, aFracHi, aFracLo);
849
850 if ((aFracHi & 0xFFFFF000u) != 0u)
851 return mix(~0u, 0u, (aSign != 0u));
852
853 uint z = 0u;
854 uint zero = 0u;
855 __shift64Right(aFracHi, aFracLo, 12, zero, z);
856
857 uint expt = mix(~0u, 0u, (aSign != 0u));
858
859 return mix(z, expt, (aSign != 0u) && (z != 0u));
860 }
861
862 uint64_t
863 __uint_to_fp64(uint a)
864 {
865 if (a == 0u)
866 return 0ul;
867
868 int shiftDist = __countLeadingZeros32(a) + 21;
869
870 uint aHigh = 0u;
871 uint aLow = 0u;
872 int negCount = (- shiftDist) & 31;
873
874 aHigh = mix(0u, a<< shiftDist - 32, shiftDist < 64);
875 aLow = 0u;
876 aHigh = mix(aHigh, 0u, shiftDist == 0);
877 aLow = mix(aLow, a, shiftDist ==0);
878 aHigh = mix(aHigh, a >> negCount, shiftDist < 32);
879 aLow = mix(aLow, a << shiftDist, shiftDist < 32);
880
881 return __packFloat64(0u, 0x432 - shiftDist, aHigh, aLow);
882 }
883
884 /* Returns the result of converting the double-precision floating-point value
885 * `a' to the 32-bit two's complement integer format. The conversion is
886 * performed according to the IEEE Standard for Floating-Point Arithmetic---
887 * which means in particular that the conversion is rounded according to the
888 * current rounding mode. If `a' is a NaN, the largest positive integer is
889 * returned. Otherwise, if the conversion overflows, the largest integer with
890 * the same sign as `a' is returned.
891 */
892 int
893 __fp64_to_int(uint64_t a)
894 {
895 uint aFracLo = __extractFloat64FracLo(a);
896 uint aFracHi = __extractFloat64FracHi(a);
897 int aExp = __extractFloat64Exp(a);
898 uint aSign = __extractFloat64Sign(a);
899
900 uint absZ = 0u;
901 uint aFracExtra = 0u;
902 int shiftCount = aExp - 0x413;
903
904 if (0 <= shiftCount) {
905 if (0x41E < aExp) {
906 if ((aExp == 0x7FF) && bool(aFracHi | aFracLo))
907 aSign = 0u;
908 return mix(0x7FFFFFFF, 0x80000000, bool(aSign));
909 }
910 __shortShift64Left(aFracHi | 0x00100000u, aFracLo, shiftCount, absZ, aFracExtra);
911 } else {
912 if (aExp < 0x3FF)
913 return 0;
914
915 aFracHi |= 0x00100000u;
916 aFracExtra = ( aFracHi << (shiftCount & 31)) | aFracLo;
917 absZ = aFracHi >> (- shiftCount);
918 }
919
920 int z = mix(int(absZ), -int(absZ), (aSign != 0u));
921 int nan = mix(0x7FFFFFFF, 0x80000000, bool(aSign));
922 return mix(z, nan, bool(aSign ^ uint(z < 0)) && bool(z));
923 }
924
925 /* Returns the result of converting the 32-bit two's complement integer `a'
926 * to the double-precision floating-point format. The conversion is performed
927 * according to the IEEE Standard for Floating-Point Arithmetic.
928 */
929 uint64_t
930 __int_to_fp64(int a)
931 {
932 uint zFrac0 = 0u;
933 uint zFrac1 = 0u;
934 if (a==0)
935 return __packFloat64(0u, 0, 0u, 0u);
936 uint zSign = uint(a < 0);
937 uint absA = mix(uint(a), uint(-a), a < 0);
938 int shiftCount = __countLeadingZeros32(absA) - 11;
939 if (0 <= shiftCount) {
940 zFrac0 = absA << shiftCount;
941 zFrac1 = 0u;
942 } else {
943 __shift64Right(absA, 0u, -shiftCount, zFrac0, zFrac1);
944 }
945 return __packFloat64(zSign, 0x412 - shiftCount, zFrac0, zFrac1);
946 }
947
948 /* Packs the sign `zSign', exponent `zExp', and significand `zFrac' into a
949 * single-precision floating-point value, returning the result. After being
950 * shifted into the proper positions, the three fields are simply added
951 * together to form the result. This means that any integer portion of `zSig'
952 * will be added into the exponent. Since a properly normalized significand
953 * will have an integer portion equal to 1, the `zExp' input should be 1 less
954 * than the desired result exponent whenever `zFrac' is a complete, normalized
955 * significand.
956 */
957 float
958 __packFloat32(uint zSign, int zExp, uint zFrac)
959 {
960 return uintBitsToFloat((zSign<<31) + (uint(zExp)<<23) + zFrac);
961 }
962
963 /* Takes an abstract floating-point value having sign `zSign', exponent `zExp',
964 * and significand `zFrac', and returns the proper single-precision floating-
965 * point value corresponding to the abstract input. Ordinarily, the abstract
966 * value is simply rounded and packed into the single-precision format, with
967 * the inexact exception raised if the abstract input cannot be represented
968 * exactly. However, if the abstract value is too large, the overflow and
969 * inexact exceptions are raised and an infinity or maximal finite value is
970 * returned. If the abstract value is too small, the input value is rounded to
971 * a subnormal number, and the underflow and inexact exceptions are raised if
972 * the abstract input cannot be represented exactly as a subnormal single-
973 * precision floating-point number.
974 * The input significand `zFrac' has its binary point between bits 30
975 * and 29, which is 7 bits to the left of the usual location. This shifted
976 * significand must be normalized or smaller. If `zFrac' is not normalized,
977 * `zExp' must be 0; in that case, the result returned is a subnormal number,
978 * and it must not require rounding. In the usual case that `zFrac' is
979 * normalized, `zExp' must be 1 less than the "true" floating-point exponent.
980 * The handling of underflow and overflow follows the IEEE Standard for
981 * Floating-Point Arithmetic.
982 */
983 float
984 __roundAndPackFloat32(uint zSign, int zExp, uint zFrac)
985 {
986 bool roundNearestEven;
987 int roundIncrement;
988 int roundBits;
989
990 roundNearestEven = FLOAT_ROUNDING_MODE == FLOAT_ROUND_NEAREST_EVEN;
991 roundIncrement = 0x40;
992 if (!roundNearestEven) {
993 if (FLOAT_ROUNDING_MODE == FLOAT_ROUND_TO_ZERO) {
994 roundIncrement = 0;
995 } else {
996 roundIncrement = 0x7F;
997 if (zSign != 0u) {
998 if (FLOAT_ROUNDING_MODE == FLOAT_ROUND_UP)
999 roundIncrement = 0;
1000 } else {
1001 if (FLOAT_ROUNDING_MODE == FLOAT_ROUND_DOWN)
1002 roundIncrement = 0;
1003 }
1004 }
1005 }
1006 roundBits = int(zFrac & 0x7Fu);
1007 if (0xFDu <= uint(zExp)) {
1008 if ((0xFD < zExp) || ((zExp == 0xFD) && (int(zFrac) + roundIncrement) < 0))
1009 return __packFloat32(zSign, 0xFF, 0u) - float(roundIncrement == 0);
1010 int count = -zExp;
1011 bool zexp_lt0 = zExp < 0;
1012 uint zFrac_lt0 = mix(uint(zFrac != 0u), (zFrac>>count) | uint((zFrac<<((-count) & 31)) != 0u), (-zExp) < 32);
1013 zFrac = mix(zFrac, zFrac_lt0, zexp_lt0);
1014 roundBits = mix(roundBits, int(zFrac) & 0x7f, zexp_lt0);
1015 zExp = mix(zExp, 0, zexp_lt0);
1016 }
1017 zFrac = (zFrac + uint(roundIncrement))>>7;
1018 zFrac &= ~uint(((roundBits ^ 0x40) == 0) && roundNearestEven);
1019
1020 return __packFloat32(zSign, mix(zExp, 0, zFrac == 0u), zFrac);
1021 }
1022
1023 /* Returns the result of converting the double-precision floating-point value
1024 * `a' to the single-precision floating-point format. The conversion is
1025 * performed according to the IEEE Standard for Floating-Point Arithmetic.
1026 */
1027 float
1028 __fp64_to_fp32(uint64_t __a)
1029 {
1030 uvec2 a = unpackUint2x32(__a);
1031 uint zFrac = 0u;
1032 uint allZero = 0u;
1033
1034 uint aFracLo = __extractFloat64FracLo(__a);
1035 uint aFracHi = __extractFloat64FracHi(__a);
1036 int aExp = __extractFloat64Exp(__a);
1037 uint aSign = __extractFloat64Sign(__a);
1038 if (aExp == 0x7FF) {
1039 __shortShift64Left(a.y, a.x, 12, a.y, a.x);
1040 float rval = uintBitsToFloat((aSign<<31) | 0x7FC00000u | (a.y>>9));
1041 rval = mix(__packFloat32(aSign, 0xFF, 0u), rval, (aFracHi | aFracLo) != 0u);
1042 return rval;
1043 }
1044 __shift64RightJamming(aFracHi, aFracLo, 22, allZero, zFrac);
1045 zFrac = mix(zFrac, zFrac | 0x40000000u, aExp != 0);
1046 return __roundAndPackFloat32(aSign, aExp - 0x381, zFrac);
1047 }
1048
1049 /* Returns the result of converting the single-precision floating-point value
1050 * `a' to the double-precision floating-point format.
1051 */
1052 uint64_t
1053 __fp32_to_fp64(float f)
1054 {
1055 uint a = floatBitsToUint(f);
1056 uint aFrac = a & 0x007FFFFFu;
1057 int aExp = int((a>>23) & 0xFFu);
1058 uint aSign = a>>31;
1059 uint zFrac0 = 0u;
1060 uint zFrac1 = 0u;
1061
1062 if (aExp == 0xFF) {
1063 if (aFrac != 0u) {
1064 uint nanLo = 0u;
1065 uint nanHi = a<<9;
1066 __shift64Right(nanHi, nanLo, 12, nanHi, nanLo);
1067 nanHi |= ((aSign<<31) | 0x7FF80000u);
1068 return packUint2x32(uvec2(nanLo, nanHi));
1069 }
1070 return __packFloat64(aSign, 0x7FF, 0u, 0u);
1071 }
1072
1073 if (aExp == 0) {
1074 if (aFrac == 0u)
1075 return __packFloat64(aSign, 0, 0u, 0u);
1076 /* Normalize subnormal */
1077 int shiftCount = __countLeadingZeros32(aFrac) - 8;
1078 aFrac <<= shiftCount;
1079 aExp = 1 - shiftCount;
1080 --aExp;
1081 }
1082
1083 __shift64Right(aFrac, 0u, 3, zFrac0, zFrac1);
1084 return __packFloat64(aSign, aExp + 0x380, zFrac0, zFrac1);
1085 }
1086
1087 /* Adds the 96-bit value formed by concatenating `a0', `a1', and `a2' to the
1088 * 96-bit value formed by concatenating `b0', `b1', and `b2'. Addition is
1089 * modulo 2^96, so any carry out is lost. The result is broken into three
1090 * 32-bit pieces which are stored at the locations pointed to by `z0Ptr',
1091 * `z1Ptr', and `z2Ptr'.
1092 */
1093 void
1094 __add96(uint a0, uint a1, uint a2,
1095 uint b0, uint b1, uint b2,
1096 out uint z0Ptr,
1097 out uint z1Ptr,
1098 out uint z2Ptr)
1099 {
1100 uint z2 = a2 + b2;
1101 uint carry1 = uint(z2 < a2);
1102 uint z1 = a1 + b1;
1103 uint carry0 = uint(z1 < a1);
1104 uint z0 = a0 + b0;
1105 z1 += carry1;
1106 z0 += uint(z1 < carry1);
1107 z0 += carry0;
1108 z2Ptr = z2;
1109 z1Ptr = z1;
1110 z0Ptr = z0;
1111 }
1112
1113 /* Subtracts the 96-bit value formed by concatenating `b0', `b1', and `b2' from
1114 * the 96-bit value formed by concatenating `a0', `a1', and `a2'. Subtraction
1115 * is modulo 2^96, so any borrow out (carry out) is lost. The result is broken
1116 * into three 32-bit pieces which are stored at the locations pointed to by
1117 * `z0Ptr', `z1Ptr', and `z2Ptr'.
1118 */
1119 void
1120 __sub96(uint a0, uint a1, uint a2,
1121 uint b0, uint b1, uint b2,
1122 out uint z0Ptr,
1123 out uint z1Ptr,
1124 out uint z2Ptr)
1125 {
1126 uint z2 = a2 - b2;
1127 uint borrow1 = uint(a2 < b2);
1128 uint z1 = a1 - b1;
1129 uint borrow0 = uint(a1 < b1);
1130 uint z0 = a0 - b0;
1131 z0 -= uint(z1 < borrow1);
1132 z1 -= borrow1;
1133 z0 -= borrow0;
1134 z2Ptr = z2;
1135 z1Ptr = z1;
1136 z0Ptr = z0;
1137 }
1138
1139 /* Returns an approximation to the 32-bit integer quotient obtained by dividing
1140 * `b' into the 64-bit value formed by concatenating `a0' and `a1'. The
1141 * divisor `b' must be at least 2^31. If q is the exact quotient truncated
1142 * toward zero, the approximation returned lies between q and q + 2 inclusive.
1143 * If the exact quotient q is larger than 32 bits, the maximum positive 32-bit
1144 * unsigned integer is returned.
1145 */
1146 uint
1147 __estimateDiv64To32(uint a0, uint a1, uint b)
1148 {
1149 uint b0;
1150 uint b1;
1151 uint rem0 = 0u;
1152 uint rem1 = 0u;
1153 uint term0 = 0u;
1154 uint term1 = 0u;
1155 uint z;
1156
1157 if (b <= a0)
1158 return 0xFFFFFFFFu;
1159 b0 = b>>16;
1160 z = (b0<<16 <= a0) ? 0xFFFF0000u : (a0 / b0)<<16;
1161 __mul32To64(b, z, term0, term1);
1162 __sub64(a0, a1, term0, term1, rem0, rem1);
1163 while (int(rem0) < 0) {
1164 z -= 0x10000u;
1165 b1 = b<<16;
1166 __add64(rem0, rem1, b0, b1, rem0, rem1);
1167 }
1168 rem0 = (rem0<<16) | (rem1>>16);
1169 z |= (b0<<16 <= rem0) ? 0xFFFFu : rem0 / b0;
1170 return z;
1171 }
1172
1173 uint
1174 __sqrtOddAdjustments(int index)
1175 {
1176 uint res = 0u;
1177 if (index == 0)
1178 res = 0x0004u;
1179 if (index == 1)
1180 res = 0x0022u;
1181 if (index == 2)
1182 res = 0x005Du;
1183 if (index == 3)
1184 res = 0x00B1u;
1185 if (index == 4)
1186 res = 0x011Du;
1187 if (index == 5)
1188 res = 0x019Fu;
1189 if (index == 6)
1190 res = 0x0236u;
1191 if (index == 7)
1192 res = 0x02E0u;
1193 if (index == 8)
1194 res = 0x039Cu;
1195 if (index == 9)
1196 res = 0x0468u;
1197 if (index == 10)
1198 res = 0x0545u;
1199 if (index == 11)
1200 res = 0x631u;
1201 if (index == 12)
1202 res = 0x072Bu;
1203 if (index == 13)
1204 res = 0x0832u;
1205 if (index == 14)
1206 res = 0x0946u;
1207 if (index == 15)
1208 res = 0x0A67u;
1209
1210 return res;
1211 }
1212
1213 uint
1214 __sqrtEvenAdjustments(int index)
1215 {
1216 uint res = 0u;
1217 if (index == 0)
1218 res = 0x0A2Du;
1219 if (index == 1)
1220 res = 0x08AFu;
1221 if (index == 2)
1222 res = 0x075Au;
1223 if (index == 3)
1224 res = 0x0629u;
1225 if (index == 4)
1226 res = 0x051Au;
1227 if (index == 5)
1228 res = 0x0429u;
1229 if (index == 6)
1230 res = 0x0356u;
1231 if (index == 7)
1232 res = 0x029Eu;
1233 if (index == 8)
1234 res = 0x0200u;
1235 if (index == 9)
1236 res = 0x0179u;
1237 if (index == 10)
1238 res = 0x0109u;
1239 if (index == 11)
1240 res = 0x00AFu;
1241 if (index == 12)
1242 res = 0x0068u;
1243 if (index == 13)
1244 res = 0x0034u;
1245 if (index == 14)
1246 res = 0x0012u;
1247 if (index == 15)
1248 res = 0x0002u;
1249
1250 return res;
1251 }
1252
1253 /* Returns an approximation to the square root of the 32-bit significand given
1254 * by `a'. Considered as an integer, `a' must be at least 2^31. If bit 0 of
1255 * `aExp' (the least significant bit) is 1, the integer returned approximates
1256 * 2^31*sqrt(`a'/2^31), where `a' is considered an integer. If bit 0 of `aExp'
1257 * is 0, the integer returned approximates 2^31*sqrt(`a'/2^30). In either
1258 * case, the approximation returned lies strictly within +/-2 of the exact
1259 * value.
1260 */
1261 uint
1262 __estimateSqrt32(int aExp, uint a)
1263 {
1264 uint z;
1265
1266 int index = int(a>>27 & 15u);
1267 if ((aExp & 1) != 0) {
1268 z = 0x4000u + (a>>17) - __sqrtOddAdjustments(index);
1269 z = ((a / z)<<14) + (z<<15);
1270 a >>= 1;
1271 } else {
1272 z = 0x8000u + (a>>17) - __sqrtEvenAdjustments(index);
1273 z = a / z + z;
1274 z = (0x20000u <= z) ? 0xFFFF8000u : (z<<15);
1275 if (z <= a)
1276 return uint(int(a)>>1);
1277 }
1278 return ((__estimateDiv64To32(a, 0u, z))>>1) + (z>>1);
1279 }
1280
1281 /* Returns the square root of the double-precision floating-point value `a'.
1282 * The operation is performed according to the IEEE Standard for Floating-Point
1283 * Arithmetic.
1284 */
1285 uint64_t
1286 __fsqrt64(uint64_t a)
1287 {
1288 uint zFrac0 = 0u;
1289 uint zFrac1 = 0u;
1290 uint zFrac2 = 0u;
1291 uint doubleZFrac0 = 0u;
1292 uint rem0 = 0u;
1293 uint rem1 = 0u;
1294 uint rem2 = 0u;
1295 uint rem3 = 0u;
1296 uint term0 = 0u;
1297 uint term1 = 0u;
1298 uint term2 = 0u;
1299 uint term3 = 0u;
1300 uint64_t default_nan = 0xFFFFFFFFFFFFFFFFUL;
1301
1302 uint aFracLo = __extractFloat64FracLo(a);
1303 uint aFracHi = __extractFloat64FracHi(a);
1304 int aExp = __extractFloat64Exp(a);
1305 uint aSign = __extractFloat64Sign(a);
1306 if (aExp == 0x7FF) {
1307 if ((aFracHi | aFracLo) != 0u)
1308 return __propagateFloat64NaN(a, a);
1309 if (aSign == 0u)
1310 return a;
1311 return default_nan;
1312 }
1313 if (aSign != 0u) {
1314 if ((uint(aExp) | aFracHi | aFracLo) == 0u)
1315 return a;
1316 return default_nan;
1317 }
1318 if (aExp == 0) {
1319 if ((aFracHi | aFracLo) == 0u)
1320 return __packFloat64(0u, 0, 0u, 0u);
1321 __normalizeFloat64Subnormal(aFracHi, aFracLo, aExp, aFracHi, aFracLo);
1322 }
1323 int zExp = ((aExp - 0x3FF)>>1) + 0x3FE;
1324 aFracHi |= 0x00100000u;
1325 __shortShift64Left(aFracHi, aFracLo, 11, term0, term1);
1326 zFrac0 = (__estimateSqrt32(aExp, term0)>>1) + 1u;
1327 if (zFrac0 == 0u)
1328 zFrac0 = 0x7FFFFFFFu;
1329 doubleZFrac0 = zFrac0 + zFrac0;
1330 __shortShift64Left(aFracHi, aFracLo, 9 - (aExp & 1), aFracHi, aFracLo);
1331 __mul32To64(zFrac0, zFrac0, term0, term1);
1332 __sub64(aFracHi, aFracLo, term0, term1, rem0, rem1);
1333 while (int(rem0) < 0) {
1334 --zFrac0;
1335 doubleZFrac0 -= 2u;
1336 __add64(rem0, rem1, 0u, doubleZFrac0 | 1u, rem0, rem1);
1337 }
1338 zFrac1 = __estimateDiv64To32(rem1, 0u, doubleZFrac0);
1339 if ((zFrac1 & 0x1FFu) <= 5u) {
1340 if (zFrac1 == 0u)
1341 zFrac1 = 1u;
1342 __mul32To64(doubleZFrac0, zFrac1, term1, term2);
1343 __sub64(rem1, 0u, term1, term2, rem1, rem2);
1344 __mul32To64(zFrac1, zFrac1, term2, term3);
1345 __sub96(rem1, rem2, 0u, 0u, term2, term3, rem1, rem2, rem3);
1346 while (int(rem1) < 0) {
1347 --zFrac1;
1348 __shortShift64Left(0u, zFrac1, 1, term2, term3);
1349 term3 |= 1u;
1350 term2 |= doubleZFrac0;
1351 __add96(rem1, rem2, rem3, 0u, term2, term3, rem1, rem2, rem3);
1352 }
1353 zFrac1 |= uint((rem1 | rem2 | rem3) != 0u);
1354 }
1355 __shift64ExtraRightJamming(zFrac0, zFrac1, 0u, 10, zFrac0, zFrac1, zFrac2);
1356 return __roundAndPackFloat64(0u, zExp, zFrac0, zFrac1, zFrac2);
1357 }
1358
1359 uint64_t
1360 __ftrunc64(uint64_t __a)
1361 {
1362 uvec2 a = unpackUint2x32(__a);
1363 int aExp = __extractFloat64Exp(__a);
1364 uint zLo;
1365 uint zHi;
1366
1367 int unbiasedExp = aExp - 1023;
1368 int fracBits = 52 - unbiasedExp;
1369 uint maskLo = mix(~0u << fracBits, 0u, fracBits >= 32);
1370 uint maskHi = mix(~0u << (fracBits - 32), ~0u, fracBits < 33);
1371 zLo = maskLo & a.x;
1372 zHi = maskHi & a.y;
1373
1374 zLo = mix(zLo, 0u, unbiasedExp < 0);
1375 zHi = mix(zHi, 0u, unbiasedExp < 0);
1376 zLo = mix(zLo, a.x, unbiasedExp > 52);
1377 zHi = mix(zHi, a.y, unbiasedExp > 52);
1378 return packUint2x32(uvec2(zLo, zHi));
1379 }