common/m9x/lrintl.c

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
ddc0e0b53c661f6e439e3b7072b3ef353eadb4afRichard Lowe#pragma weak __lrintl = lrintl
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#include <sys/isa_defs.h>   /* _ILP32 */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#include "libm.h"
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#if defined(_ILP32)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#if defined(__sparc)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#include "fma.h"
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#include "fenv_inlines.h"
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtislong
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtislrintl(long double x) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    union {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        unsigned int i[4];
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        long double q;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    } xx;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    union {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        unsigned int i;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        float f;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    } tt;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    unsigned int hx, sx, frac, l, fsr;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    int rm, j;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    volatile float dummy;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    xx.q = x;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    sx = xx.i[0] & 0x80000000;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    hx = xx.i[0] & ~0x80000000;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    /* handle trivial cases */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    if (hx > 0x401e0000) { /* |x| > 2^31 + ... or x is nan */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        /* convert an out-of-range float */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        tt.i = sx | 0x7f000000;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        return ((long) tt.f);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    } else if ((hx | xx.i[1] | xx.i[2] | xx.i[3]) == 0) /* x is zero */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        return (0L);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    /* get the rounding mode */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    __fenv_getfsr32(&fsr);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    rm = fsr >> 30;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    /* flip the sense of directed roundings if x is negative */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    if (sx)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        rm ^= rm >> 1;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    /* handle |x| < 1 */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    if (hx < 0x3fff0000) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        dummy = 1.0e30F; /* x is nonzero, so raise inexact */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        dummy += 1.0e-30F;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        if (rm == FSR_RP || (rm == FSR_RN && (hx >= 0x3ffe0000 &&
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis            ((hx & 0xffff) | xx.i[1] | xx.i[2] | xx.i[3]))))
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis            return (sx ? -1L : 1L);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        return (0L);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    /* extract the integer and fractional parts of x */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    j = 0x406f - (hx >> 16);        /* 91 <= j <= 112 */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    xx.i[0] = 0x10000 | (xx.i[0] & 0xffff);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    if (j >= 96) {              /* 96 <= j <= 112 */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        l = xx.i[0] >> (j - 96);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        frac = ((xx.i[0] << 1) << (127 - j)) | (xx.i[1] >> (j - 96));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        if (((xx.i[1] << 1) << (127 - j)) | xx.i[2] | xx.i[3])
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis            frac |= 1;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    } else {                /* 91 <= j <= 95 */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        l = (xx.i[0] << (96 - j)) | (xx.i[1] >> (j - 64));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        frac = (xx.i[1] << (96 - j)) | (xx.i[2] >> (j - 64));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        if ((xx.i[2] << (96 - j)) | xx.i[3])
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis            frac |= 1;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    /* round */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    if (frac && (rm == FSR_RP || (rm == FSR_RN && (frac > 0x80000000U ||
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        (frac == 0x80000000 && (l & 1))))))
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        l++;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    /* check for result out of range (note that z is |x| at this point) */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    if (l > 0x80000000U || (l == 0x80000000U && !sx)) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        tt.i = sx | 0x7f000000;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        return ((long) tt.f);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    /* raise inexact if need be */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    if (frac) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        dummy = 1.0e30F;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        dummy += 1.0e-30F;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    /* negate result if need be */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    if (sx)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        l = -l;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    return ((long) l);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#elif defined(__x86)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtislong
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtislrintl(long double x) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    /*
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis     * Note: The following code works on x86 (in the default rounding
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis     * precision mode), but one ought to just use the fistpl instruction
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis     * instead.
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis     */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    union {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        unsigned i[3];
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        long double e;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    } xx, yy;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    int ex;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    xx.e = x;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    ex = xx.i[2] & 0x7fff;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    if (ex < 0x403e) {  /* |x| < 2^63 */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        /* add and subtract a power of two to round x to an integer */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        yy.i[2] = (xx.i[2] & 0x8000) | 0x403e;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        yy.i[1] = 0x80000000;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        yy.i[0] = 0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        x = (x + yy.e) - yy.e;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    /* now x is nan, inf, or integral */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    return ((long) x);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#else
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#error Unknown architecture
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#endif  /* defined(__sparc) || defined(__x86) */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#else
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#error Unsupported architecture
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#endif  /* defined(_ILP32) */