common/m9x/feexcept.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 __feclearexcept = feclearexcept
ddc0e0b53c661f6e439e3b7072b3ef353eadb4afRichard Lowe#pragma weak __feraiseexcept = feraiseexcept
ddc0e0b53c661f6e439e3b7072b3ef353eadb4afRichard Lowe#pragma weak __fetestexcept = fetestexcept
ddc0e0b53c661f6e439e3b7072b3ef353eadb4afRichard Lowe#pragma weak __fegetexceptflag = fegetexceptflag
ddc0e0b53c661f6e439e3b7072b3ef353eadb4afRichard Lowe#pragma weak __fesetexceptflag = fesetexceptflag
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
ddc0e0b53c661f6e439e3b7072b3ef353eadb4afRichard Lowe#pragma weak feclearexcept96 = feclearexcept
ddc0e0b53c661f6e439e3b7072b3ef353eadb4afRichard Lowe#pragma weak feraiseexcept96 = feraiseexcept
ddc0e0b53c661f6e439e3b7072b3ef353eadb4afRichard Lowe#pragma weak fetestexcept96 = fetestexcept
ddc0e0b53c661f6e439e3b7072b3ef353eadb4afRichard Lowe#pragma weak fegetexceptflag96 = fegetexceptflag
ddc0e0b53c661f6e439e3b7072b3ef353eadb4afRichard Lowe#pragma weak fesetexceptflag96 = fesetexceptflag
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#include <fenv.h>
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#include <sys/ieeefp.h>
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#include <ucontext.h>
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#include <thread.h>
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#include "fex_handler.h"
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#include "fenv_inlines.h"
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtisint feclearexcept(int e)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis{
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    unsigned long   fsr;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    __fenv_getfsr(&fsr);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    __fenv_set_ex(fsr, __fenv_get_ex(fsr) & ~e);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    __fenv_setfsr(&fsr);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    if (fex_get_log())
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        __fex_update_te();
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    return 0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis/*
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis*  note - __fex_hdlr depends on fetestexcept following feraiseexcept
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis*/
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtisint feraiseexcept(int e)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis{
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    volatile double t;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    unsigned long   fsr;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    if (e & FE_INVALID) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        t = 0.0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        t /= 0.0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    if (e & FE_DIVBYZERO) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        t = 1.0e300;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        t /= 0.0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    if (e & FE_OVERFLOW) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        /* if overflow is not trapped, avoid raising inexact */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        __fenv_getfsr(&fsr);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        if (!(__fenv_get_te(fsr) & (1 << fp_trap_overflow))) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis            __fenv_set_ex(fsr, __fenv_get_ex(fsr) | FE_OVERFLOW);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis            __fenv_setfsr(&fsr);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        else {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis            t = 1.0e300;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis            t *= 1.0e300;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    if (e & FE_UNDERFLOW) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        /* if underflow is not trapped, avoid raising inexact */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        __fenv_getfsr(&fsr);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        if (!(__fenv_get_te(fsr) & (1 << fp_trap_underflow))) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis            __fenv_set_ex(fsr, __fenv_get_ex(fsr) | FE_UNDERFLOW);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis            __fenv_setfsr(&fsr);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        else {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis            t = 1.0e-307;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis            t -= 1.001e-307;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    if (e & FE_INEXACT) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        t = 1.0e300;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        t += 1.0e-307;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    }
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    return 0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtisint fetestexcept(int e)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis{
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    unsigned long   fsr;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    __fenv_getfsr(&fsr);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    return (int)__fenv_get_ex(fsr) & e;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtisint fegetexceptflag(fexcept_t *p, int e)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis{
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    unsigned long   fsr;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    __fenv_getfsr(&fsr);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    *p = (int)__fenv_get_ex(fsr) & e;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    return 0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtisint fesetexceptflag(const fexcept_t *p, int e)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis{
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    unsigned long   fsr;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    __fenv_getfsr(&fsr);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    __fenv_set_ex(fsr, (((int)__fenv_get_ex(fsr) & ~e) | (*p & e)) &
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        FE_ALL_EXCEPT);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    __fenv_setfsr(&fsr);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    if (fex_get_log())
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis        __fex_update_te();
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis    return 0;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}