/*
 * CDDL HEADER START
 *
 * The contents of this file are subject to the terms of the
 * Common Development and Distribution License (the "License").
 * You may not use this file except in compliance with the License.
 *
 * You can obtain a copy of the license at usr/src/OPENSOLARIS.LICENSE
 * or http://www.opensolaris.org/os/licensing.
 * See the License for the specific language governing permissions
 * and limitations under the License.
 *
 * When distributing Covered Code, include this CDDL HEADER in each
 * file and include the License file at usr/src/OPENSOLARIS.LICENSE.
 * If applicable, add the following below this CDDL HEADER, with the
 * fields enclosed by brackets "[]" replaced with your own identifying
 * information: Portions Copyright [yyyy] [name of copyright owner]
 *
 * CDDL HEADER END
 */

/*
 * Copyright 2006 Sun Microsystems, Inc.  All rights reserved.
 * Use is subject to license terms.
 */

/*
 * Copyright 2011, Richard Lowe.
 */

#ifndef _LIBM_INLINES_H
#define _LIBM_INLINES_H

#ifdef __GNUC__

#include <sys/types.h>
#include <sys/ieeefp.h>

#ifdef __cplusplus
extern "C" {
#endif

extern __GNU_INLINE enum fp_class_type
fp_classf(float f)
{
        enum fp_class_type ret;
        int fint;               /* scratch for f as int */
        uint64_t tmp;

        __asm__ __volatile__(
            "fabss  %3,%3\n\t"
            "st     %3,%1\n\t"
            "ld     %1,%0\n\t"
            "orcc   %%g0,%0,%%g0\n\t"
            "be,pn  %%icc,2f\n\t"
            "nop\n\t"
            "1:\n\t"
            "sethi  %%hi(0x7f800000),%2\n\t"
            "andcc  %0,%2,%%g0\n\t"
            "bne,pt %%icc,1f\n\t"
            "nop\n\t"
            "or     %%g0,1,%0\n\t"
            "ba     2f\n\t"     /* subnormal */
            "nop\n\t"
            "1:\n\t"
            "subcc  %0,%2,%%g0\n\t"
            "bge,pn %%icc,1f\n\t"
            "nop\n\t"
            "or     %%g0,2,%0\n\t"
            "ba     2f\n\t"     /* normal */
            "nop\n\t"
            "1:\n\t"
            "bg,pn  %%icc,1f\n\t"
            "nop\n\t"
            "or     %%g0,3,%0\n\t"
            "ba     2f\n\t"     /* infinity */
            "nop\n\t"
            "1:\n\t"
            "sethi  %%hi(0x00400000),%2\n\t"
            "andcc  %0,%2,%%g0\n\t"
            "or     %%g0,4,%0\n\t"
            "bne,pt %%icc,2f\n\t" /* quiet NaN */
            "nop\n\t"
            "or     %%g0,5,%0\n\t" /* signalling NaN */
            "2:\n\t"
            : "=r" (ret), "=m" (fint), "=r" (tmp), "+f" (f)
            :
            : "cc");

        return (ret);
}

extern __GNU_INLINE enum fp_class_type
fp_class(double d)
{
        enum fp_class_type ret;
        uint64_t dint;          /* Scratch for d-as-long */
        uint64_t tmp;

        __asm__ __volatile__(
            "fabsd  %3,%3\n\t"
            "std    %3,%1\n\t"
            "ldx    %1,%0\n\t"
            "orcc   %%g0,%0,%%g0\n\t"
            "be,pn  %%xcc,2f\n\t"
            "nop\n\t"
            "sethi  %%hi(0x7ff00000),%2\n\t"
            "sllx   %2,32,%2\n\t"
            "andcc  %0,%2,%%g0\n\t"
            "bne,pt %%xcc,1f\n\t"
            "nop\n\t"
            "or     %%g0,1,%0\n\t"
            "ba     2f\n\t"
            "nop\n\t"
            "1:\n\t"
            "subcc  %0,%2,%%g0\n\t"
            "bge,pn %%xcc,1f\n\t"
            "nop\n\t"
            "or     %%g0,2,%0\n\t"
            "ba     2f\n\t"
            "nop\n\t"
            "1:\n\t"
            "andncc %0,%2,%0\n\t"
            "bne,pn %%xcc,1f\n\t"
            "nop\n\t"
            "or     %%g0,3,%0\n\t"
            "ba     2f\n\t"
            "nop\n\t"
            "1:\n\t"
            "sethi  %%hi(0x00080000),%2\n\t"
            "sllx   %2,32,%2\n\t"
            "andcc  %0,%2,%%g0\n\t"
            "or     %%g0,4,%0\n\t"
            "bne,pt %%xcc,2f\n\t"
            "nop\n\t"
            "or     %%g0,5,%0\n\t"
            "2:\n\t"
            : "=r" (ret), "=m" (dint), "=r" (tmp), "+e" (d)
            :
            : "cc");

        return (ret);
}

extern __GNU_INLINE float
__inline_sqrtf(float f)
{
        float ret;

        __asm__ __volatile__("fsqrts %1,%0\n\t" : "=f" (ret) : "f" (f));
        return (ret);
}

extern __GNU_INLINE double
__inline_sqrt(double d)
{
        double ret;

        __asm__ __volatile__("fsqrtd %1,%0\n\t" : "=f" (ret) : "f" (d));
        return (ret);
}

extern __GNU_INLINE int
__swapEX(int i)
{
        int ret;
        uint32_t fsr;
        uint64_t tmp1, tmp2;

        __asm__ __volatile__(
            "and  %4,0x1f,%2\n\t"
            "sll  %2,5,%2\n\t"  /* shift input to aexc bit location */
            ".volatile\n\t"
            "st   %%fsr,%1\n\t"
            "ld   %1,%0\n\t"    /* %0 = fsr */
            "andn %0,0x3e0,%3\n\t"
            "or   %2,%3,%2\n\t" /* %2 = new fsr */
            "st   %2,%1\n\t"
            "ld   %1,%%fsr\n\t"
            "srl  %0,5,%0\n\t"
            "and  %0,0x1f,%0\n\t"
            ".nonvolatile\n\t"
            : "=r" (ret), "=m" (fsr), "=r" (tmp1), "=r" (tmp2)
            : "r" (i)
            : "cc");

        return (ret);
}

/*
 * On the SPARC, __swapRP is a no-op; always return 0 for backward
 * compatibility
 */
/* ARGSUSED */
extern __GNU_INLINE enum fp_precision_type
__swapRP(enum fp_precision_type i)
{
        return (0);
}

extern __GNU_INLINE enum fp_direction_type
__swapRD(enum fp_direction_type d)
{
        enum fp_direction_type ret;
        uint32_t fsr;
        uint64_t tmp1, tmp2, tmp3;

        __asm__ __volatile__(
            "and   %5,0x3,%0\n\t"
            "sll   %0,30,%2\n\t"        /* shift input to RD bit location */
            ".volatile\n\t"
            "st    %%fsr,%1\n\t"
            "ld    %1,%0\n\t"           /* %0 = fsr */
            /* mask of rounding direction bits */
            "sethi %%hi(0xc0000000),%4\n\t"
            "andn  %0,%4,%3\n\t"
            "or    %2,%3,%2\n\t"        /* %2 = new fsr */
            "st    %2,%1\n\t"
            "ld    %1,%%fsr\n\t"
            "srl   %0,30,%0\n\t"
            "and   %0,0x3,%0\n\t"
            ".nonvolatile\n\t"
            : "=r" (ret), "=m" (fsr), "=r" (tmp1), "=r" (tmp2), "=r" (tmp3)
            : "r" (d)
            : "cc");

        return (ret);
}

extern __GNU_INLINE int
__swapTE(int i)
{
        int ret;
        uint32_t fsr;
        uint64_t tmp1, tmp2, tmp3;

        __asm__ __volatile__(
            "and   %5,0x1f,%0\n\t"
            "sll   %0,23,%2\n\t"        /* shift input to TEM bit location */
            ".volatile\n\t"
            "st    %%fsr,%1\n\t"
            "ld    %1,%0\n\t"           /* %0 = fsr */
            /* mask of TEM (Trap Enable Mode bits) */
            "sethi %%hi(0x0f800000),%4\n\t"
            "andn  %0,%4,%3\n\t"
            "or    %2,%3,%2\n\t"        /* %2 = new fsr */
            "st    %2,%1\n\t"
            "ld    %1,%%fsr\n\t"
            "srl   %0,23,%0\n\t"
            "and   %0,0x1f,%0\n\t"
            ".nonvolatile\n\t"
            : "=r" (ret), "=m" (fsr), "=r" (tmp1), "=r" (tmp2), "=r" (tmp3)
            : "r" (i)
            : "cc");

        return (ret);
}


extern __GNU_INLINE double
sqrt(double d)
{
        return (__inline_sqrt(d));
}

extern __GNU_INLINE float
sqrtf(float f)
{
        return (__inline_sqrtf(f));
}

extern __GNU_INLINE double
fabs(double d)
{
        double ret;

        __asm__ __volatile__("fabsd %1,%0\n\t" : "=e" (ret) : "e" (d));
        return (ret);
}

extern __GNU_INLINE float
fabsf(float f)
{
        float ret;

        __asm__ __volatile__("fabss %1,%0\n\t" : "=f" (ret) : "f" (f));
        return (ret);
}

#ifdef __cplusplus
}
#endif

#endif  /* __GNUC__ */

#endif /* _LIBM_INLINES_H */