25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis/*
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * CDDL HEADER START
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis *
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * The contents of this file are subject to the terms of the
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * Common Development and Distribution License (the "License").
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * You may not use this file except in compliance with the License.
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis *
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * or http://www.opensolaris.org/os/licensing.
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * See the License for the specific language governing permissions
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * and limitations under the License.
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis *
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * When distributing Covered Code, include this CDDL HEADER in each
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * If applicable, add the following below this CDDL HEADER, with the
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * fields enclosed by brackets "[]" replaced with your own identifying
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * information: Portions Copyright [yyyy] [name of copyright owner]
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis *
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * CDDL HEADER END
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis/*
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * Copyright 2011 Nexenta Systems, Inc. All rights reserved.
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis/*
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * Copyright 2006 Sun Microsystems, Inc. All rights reserved.
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * Use is subject to license terms.
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#pragma weak fma = __fma
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#include "libm.h"
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#include "fma.h"
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#include "fenv_inlines.h"
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#if defined(__sparc)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtisstatic const union {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis unsigned i[2];
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis double d;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis} C[] = {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis { 0x3fe00000u, 0 },
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis { 0x40000000u, 0 },
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis { 0x43300000u, 0 },
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis { 0x41a00000u, 0 },
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis { 0x3e500000u, 0 },
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis { 0x3df00000u, 0 },
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis { 0x3bf00000u, 0 },
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis { 0x7fe00000u, 0 },
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis { 0x00100000u, 0 },
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis { 0x00100001u, 0 }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis};
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#define half C[0].d
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#define two C[1].d
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#define two52 C[2].d
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#define two27 C[3].d
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#define twom26 C[4].d
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#define twom32 C[5].d
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#define twom64 C[6].d
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#define huge C[7].d
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#define tiny C[8].d
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#define tiny2 C[9].d
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtisstatic const unsigned int fsr_rm = 0xc0000000u;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis/*
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * fma for SPARC: 64-bit double precision, big-endian
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtisdouble
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis__fma(double x, double y, double z) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis union {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis unsigned i[2];
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis double d;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis } xx, yy, zz;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis double xhi, yhi, xlo, ylo, t;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis unsigned int xy0, xy1, xy2, xy3, z0, z1, z2, z3, fsr, rm, sticky;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis int hx, hy, hz, ex, ey, ez, exy, sxy, sz, e, ibit;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis volatile double dummy;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /* extract the high order words of the arguments */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xx.d = x;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis yy.d = y;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis zz.d = z;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis hx = xx.i[0] & ~0x80000000;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis hy = yy.i[0] & ~0x80000000;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis hz = zz.i[0] & ~0x80000000;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /* dispense with inf, nan, and zero cases */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (hx >= 0x7ff00000 || hy >= 0x7ff00000 || (hx | xx.i[1]) == 0 ||
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis (hy | yy.i[1]) == 0) /* x or y is inf, nan, or zero */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return (x * y + z);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (hz >= 0x7ff00000) /* z is inf or nan */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return (x + z); /* avoid spurious under/overflow in x * y */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if ((hz | zz.i[1]) == 0) /* z is zero */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /*
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * x * y isn't zero but could underflow to zero,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * so don't add z, lest we perturb the sign
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return (x * y);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /*
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * now x, y, and z are all finite and nonzero; save the fsr and
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * set round-to-negative-infinity mode (and clear nonstandard
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * mode before we try to scale subnormal operands)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis __fenv_getfsr32(&fsr);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis __fenv_setfsr32(&fsr_rm);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /* extract signs and exponents, and normalize subnormals */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis sxy = (xx.i[0] ^ yy.i[0]) & 0x80000000;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis sz = zz.i[0] & 0x80000000;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ex = hx >> 20;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (!ex) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xx.d = x * two52;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ex = ((xx.i[0] & ~0x80000000) >> 20) - 52;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ey = hy >> 20;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (!ey) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis yy.d = y * two52;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ey = ((yy.i[0] & ~0x80000000) >> 20) - 52;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ez = hz >> 20;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (!ez) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis zz.d = z * two52;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ez = ((zz.i[0] & ~0x80000000) >> 20) - 52;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /* multiply x*y to 106 bits */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis exy = ex + ey - 0x3ff;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xx.i[0] = (xx.i[0] & 0xfffff) | 0x3ff00000;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis yy.i[0] = (yy.i[0] & 0xfffff) | 0x3ff00000;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis x = xx.d;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis y = yy.d;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xhi = ((x + twom26) + two27) - two27;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis yhi = ((y + twom26) + two27) - two27;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xlo = x - xhi;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ylo = y - yhi;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis x *= y;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis y = ((xhi * yhi - x) + xhi * ylo + xlo * yhi) + xlo * ylo;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (x >= two) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis x *= half;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis y *= half;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis exy++;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /* extract the significands */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xx.d = x;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xy0 = (xx.i[0] & 0xfffff) | 0x100000;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xy1 = xx.i[1];
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis yy.d = t = y + twom32;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xy2 = yy.i[1];
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis yy.d = (y - (t - twom32)) + twom64;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xy3 = yy.i[1];
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z0 = (zz.i[0] & 0xfffff) | 0x100000;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z1 = zz.i[1];
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z2 = z3 = 0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /*
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * now x*y is represented by sxy, exy, and xy[0-3], and z is
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * represented likewise; swap if need be so |xy| <= |z|
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (exy > ez || (exy == ez && (xy0 > z0 || (xy0 == z0 &&
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis (xy1 > z1 || (xy1 == z1 && (xy2 | xy3) != 0)))))) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis e = sxy; sxy = sz; sz = e;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis e = exy; exy = ez; ez = e;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis e = xy0; xy0 = z0; z0 = e;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis e = xy1; xy1 = z1; z1 = e;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z2 = xy2; xy2 = 0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z3 = xy3; xy3 = 0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /* shift the significand of xy keeping a sticky bit */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis e = ez - exy;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (e > 116) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xy0 = xy1 = xy2 = 0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xy3 = 1;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis } else if (e >= 96) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis sticky = xy3 | xy2 | xy1 | ((xy0 << 1) << (127 - e));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xy3 = xy0 >> (e - 96);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (sticky)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xy3 |= 1;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xy0 = xy1 = xy2 = 0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis } else if (e >= 64) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis sticky = xy3 | xy2 | ((xy1 << 1) << (95 - e));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xy3 = (xy1 >> (e - 64)) | ((xy0 << 1) << (95 - e));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (sticky)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xy3 |= 1;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xy2 = xy0 >> (e - 64);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xy0 = xy1 = 0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis } else if (e >= 32) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis sticky = xy3 | ((xy2 << 1) << (63 - e));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xy3 = (xy2 >> (e - 32)) | ((xy1 << 1) << (63 - e));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (sticky)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xy3 |= 1;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xy2 = (xy1 >> (e - 32)) | ((xy0 << 1) << (63 - e));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xy1 = xy0 >> (e - 32);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xy0 = 0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis } else if (e) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis sticky = (xy3 << 1) << (31 - e);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xy3 = (xy3 >> e) | ((xy2 << 1) << (31 - e));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (sticky)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xy3 |= 1;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xy2 = (xy2 >> e) | ((xy1 << 1) << (31 - e));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xy1 = (xy1 >> e) | ((xy0 << 1) << (31 - e));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xy0 >>= e;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /* if this is a magnitude subtract, negate the significand of xy */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (sxy ^ sz) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xy0 = ~xy0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xy1 = ~xy1;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xy2 = ~xy2;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xy3 = -xy3;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (xy3 == 0)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (++xy2 == 0)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (++xy1 == 0)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xy0++;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /* add, propagating carries */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z3 += xy3;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis e = (z3 < xy3);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z2 += xy2;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (e) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z2++;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis e = (z2 <= xy2);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis } else
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis e = (z2 < xy2);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z1 += xy1;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (e) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z1++;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis e = (z1 <= xy1);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis } else
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis e = (z1 < xy1);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z0 += xy0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (e)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z0++;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /* postnormalize and collect rounding information into z2 */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (ez < 1) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /* result is tiny; shift right until exponent is within range */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis e = 1 - ez;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (e > 56) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z2 = 1; /* result can't be exactly zero */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z0 = z1 = 0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis } else if (e >= 32) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis sticky = z3 | z2 | ((z1 << 1) << (63 - e));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z2 = (z1 >> (e - 32)) | ((z0 << 1) << (63 - e));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (sticky)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z2 |= 1;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z1 = z0 >> (e - 32);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z0 = 0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis } else {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis sticky = z3 | (z2 << 1) << (31 - e);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z2 = (z2 >> e) | ((z1 << 1) << (31 - e));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (sticky)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z2 |= 1;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z1 = (z1 >> e) | ((z0 << 1) << (31 - e));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z0 >>= e;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ez = 1;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis } else if (z0 >= 0x200000) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /* carry out; shift right by one */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis sticky = (z2 & 1) | z3;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z2 = (z2 >> 1) | (z1 << 31);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (sticky)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z2 |= 1;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z1 = (z1 >> 1) | (z0 << 31);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z0 >>= 1;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ez++;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis } else {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (z0 < 0x100000 && (z0 | z1 | z2 | z3) != 0) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /*
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * borrow/cancellation; shift left as much as
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * exponent allows
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis while (!(z0 | (z1 & 0xffe00000)) && ez >= 33) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z0 = z1;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z1 = z2;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z2 = z3;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z3 = 0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ez -= 32;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis while (z0 < 0x100000 && ez > 1) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z0 = (z0 << 1) | (z1 >> 31);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z1 = (z1 << 1) | (z2 >> 31);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z2 = (z2 << 1) | (z3 >> 31);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z3 <<= 1;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ez--;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (z3)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z2 |= 1;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /* get the rounding mode and clear current exceptions */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis rm = fsr >> 30;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis fsr &= ~FSR_CEXC;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /* strip off the integer bit, if there is one */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ibit = z0 & 0x100000;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (ibit)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z0 -= 0x100000;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis else {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ez = 0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (!(z0 | z1 | z2)) { /* exact zero */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis zz.i[0] = rm == FSR_RM ? 0x80000000 : 0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis zz.i[1] = 0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis __fenv_setfsr32(&fsr);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return (zz.d);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /*
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * flip the sense of directed roundings if the result is negative;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * the logic below applies to a positive result
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (sz)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis rm ^= rm >> 1;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /* round and raise exceptions */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (z2) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis fsr |= FSR_NXC;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /* decide whether to round the fraction up */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (rm == FSR_RP || (rm == FSR_RN && (z2 > 0x80000000u ||
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis (z2 == 0x80000000u && (z1 & 1))))) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /* round up and renormalize if necessary */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (++z1 == 0) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (++z0 == 0x100000) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis z0 = 0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ez++;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /* check for under/overflow */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (ez >= 0x7ff) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (rm == FSR_RN || rm == FSR_RP) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis zz.i[0] = sz | 0x7ff00000;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis zz.i[1] = 0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis } else {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis zz.i[0] = sz | 0x7fefffff;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis zz.i[1] = 0xffffffff;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis fsr |= FSR_OFC | FSR_NXC;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis } else {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis zz.i[0] = sz | (ez << 20) | z0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis zz.i[1] = z1;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /*
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * !ibit => exact result was tiny before rounding,
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * z2 nonzero => result delivered is inexact
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (!ibit) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (z2)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis fsr |= FSR_UFC | FSR_NXC;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis else if (fsr & FSR_UFM)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis fsr |= FSR_UFC;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /* restore the fsr and emulate exceptions as needed */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if ((fsr & FSR_CEXC) & (fsr >> 23)) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis __fenv_setfsr32(&fsr);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (fsr & FSR_OFC) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis dummy = huge;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis dummy *= huge;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis } else if (fsr & FSR_UFC) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis dummy = tiny;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (fsr & FSR_NXC)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis dummy *= tiny;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis else
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis dummy -= tiny2;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis } else {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis dummy = huge;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis dummy += tiny;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis } else {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis fsr |= (fsr & 0x1f) << 5;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis __fenv_setfsr32(&fsr);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return (zz.d);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#elif defined(__x86)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#if defined(__amd64)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#define NI 4
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#else
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#define NI 3
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#endif
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis/*
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * fma for x86: 64-bit double precision, little-endian
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtisdouble
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis__fma(double x, double y, double z) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis union {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis unsigned i[NI];
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis long double e;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis } xx, yy, zz;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis long double xe, ye, xhi, xlo, yhi, ylo;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis int ex, ey, ez;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis unsigned cwsw, oldcwsw, rm;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /* convert the operands to double extended */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xx.e = (long double) x;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis yy.e = (long double) y;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis zz.e = (long double) z;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /* extract the exponents of the arguments */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ex = xx.i[2] & 0x7fff;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ey = yy.i[2] & 0x7fff;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ez = zz.i[2] & 0x7fff;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /* dispense with inf, nan, and zero cases */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (ex == 0x7fff || ey == 0x7fff || ex == 0 || ey == 0)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /* x or y is inf, nan, or zero */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return ((double) (xx.e * yy.e + zz.e));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (ez >= 0x7fff) /* z is inf or nan */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return ((double) (xx.e + zz.e));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /* avoid spurious inexact in x * y */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /*
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * save the control and status words, mask all exceptions, and
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * set rounding to 64-bit precision and to-nearest
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis __fenv_getcwsw(&oldcwsw);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis cwsw = (oldcwsw & 0xf0c0ffff) | 0x033f0000;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis __fenv_setcwsw(&cwsw);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /* multiply x*y to 106 bits */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xe = xx.e;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xx.i[0] = 0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xhi = xx.e; /* hi 32 bits */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xlo = xe - xhi; /* lo 21 bits */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ye = yy.e;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis yy.i[0] = 0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis yhi = yy.e;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ylo = ye - yhi;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xe = xe * ye;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ye = ((xhi * yhi - xe) + xhi * ylo + xlo * yhi) + xlo * ylo;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /* distill the sum of xe, ye, and z */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xhi = ye + zz.e;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis yhi = xhi - ye;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xlo = (zz.e - yhi) + (ye - (xhi - yhi));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /* now (xhi,xlo) = ye + z */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis yhi = xe + xhi;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ye = yhi - xe;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ylo = (xhi - ye) + (xe - (yhi - ye)); /* now (yhi,ylo) = xe + xhi */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xhi = xlo + ylo;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xe = xhi - xlo;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xlo = (ylo - xe) + (xlo - (xhi - xe)); /* now (xhi,xlo) = xlo + ylo */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis yy.e = yhi + xhi;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ylo = (yhi - yy.e) + xhi; /* now (yy.e,ylo) = xhi + yhi */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (yy.i[1] != 0) { /* yy.e is nonzero */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /* perturb yy.e if its least significant 10 bits are zero */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (!(yy.i[0] & 0x3ff)) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xx.e = ylo + xlo;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis if (xx.i[1] != 0) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xx.i[2] = (xx.i[2] & 0x8000) |
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ((yy.i[2] & 0x7fff) - 63);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xx.i[1] = 0x80000000;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis xx.i[0] = 0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis yy.e += xx.e;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis } else {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /* set sign of zero result according to rounding direction */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis rm = oldcwsw & 0x0c000000;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis yy.i[2] = ((rm == FCW_RM)? 0x8000 : 0);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /*
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * restore the control and status words and convert the result
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * to double
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis __fenv_setcwsw(&oldcwsw);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return ((double) yy.e);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#else
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#error Unknown architecture
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#endif