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 2006 Sun Microsystems, Inc. All rights reserved.
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * Use is subject to license terms.
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis/*
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * Copyright 2011, Richard Lowe
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis/* Functions in this file are duplicated in locallibm.il. Keep them in sync */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#ifndef _LIBM_INLINES_H
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#define _LIBM_INLINES_H
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#ifdef __GNUC__
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#ifdef __cplusplus
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtisextern "C" {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#endif
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#include <sys/types.h>
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#include <sys/ieeefp.h>
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#define _LO_WORD(x) ((uint32_t *)&x)[0]
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#define _HI_WORD(x) ((uint32_t *)&x)[1]
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#define _HIER_WORD(x) ((uint32_t *)&x)[2]
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
7f11fd00fc23e2af7ae21cc8837a2b86380dcfa7Richard Loweextern __GNU_INLINE double
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis__inline_sqrt(double a)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis{
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis double ret;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis __asm__ __volatile__("fsqrt\n\t" : "=t" (ret) : "0" (a) : "cc");
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return (ret);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
7f11fd00fc23e2af7ae21cc8837a2b86380dcfa7Richard Loweextern __GNU_INLINE double
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis__ieee754_sqrt(double a)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis{
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return (__inline_sqrt(a));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
7f11fd00fc23e2af7ae21cc8837a2b86380dcfa7Richard Loweextern __GNU_INLINE float
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis__inline_sqrtf(float a)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis{
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis float ret;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis __asm__ __volatile__("fsqrt\n\t" : "=t" (ret) : "0" (a) : "cc");
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return (ret);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
7f11fd00fc23e2af7ae21cc8837a2b86380dcfa7Richard Loweextern __GNU_INLINE double
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis__inline_rint(double a)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis{
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis __asm__ __volatile__(
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "andl $0x7fffffff,%1\n\t"
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "cmpl $0x43300000,%1\n\t"
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "jae 1f\n\t"
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "frndint\n\t"
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "1: fwait\n\t"
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis : "+t" (a), "+&r" (_HI_WORD(a))
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis :
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis : "cc");
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return (a);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis/*
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * 00 - 24 bits
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * 01 - reserved
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * 10 - 53 bits
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * 11 - 64 bits
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis */
7f11fd00fc23e2af7ae21cc8837a2b86380dcfa7Richard Loweextern __GNU_INLINE int
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis__swapRP(int i)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis{
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis int ret;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis uint16_t cw;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis __asm__ __volatile__("fstcw %0\n\t" : "=m" (cw));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ret = (cw >> 8) & 0x3;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis cw = (cw & 0xfcff) | ((i & 0x3) << 8);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis __asm__ __volatile__("fldcw %0\n\t" : : "m" (cw));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return (ret);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis/*
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * 00 - Round to nearest, with even preferred
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * 01 - Round down
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * 10 - Round up
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * 11 - Chop
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis */
7f11fd00fc23e2af7ae21cc8837a2b86380dcfa7Richard Loweextern __GNU_INLINE enum fp_direction_type
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis__swap87RD(enum fp_direction_type i)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis{
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis int ret;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis uint16_t cw;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis __asm__ __volatile__("fstcw %0\n\t" : "=m" (cw));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis ret = (cw >> 10) & 0x3;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis cw = (cw & 0xf3ff) | ((i & 0x3) << 10);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis __asm__ __volatile__("fldcw %0\n\t" : : "m" (cw));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return (ret);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
7f11fd00fc23e2af7ae21cc8837a2b86380dcfa7Richard Loweextern __GNU_INLINE double
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtisceil(double d)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis{
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /*
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * Let's set a Rounding Control (RC) bits from x87 FPU Control Word
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * to fp_positive and save old bits in rd.
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis short rd = __swap87RD(fp_positive);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /*
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * The FRNDINT instruction returns a floating-point value that is the
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * integral value closest to the source value in the direction of the
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * rounding mode specified in the RC field of the x87 FPU control word.
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis *
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * Rounds the source value in the ST(0) register to the nearest
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * integral value, depending on the current rounding mode
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * (setting of the RC field of the FPU control word),
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * and stores the result in ST(0).
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis __asm__ __volatile__("frndint" : "+t" (d) : : "cc");
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis /* restore old RC bits */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis __swap87RD(rd);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return (d);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
7f11fd00fc23e2af7ae21cc8837a2b86380dcfa7Richard Loweextern __GNU_INLINE double
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtiscopysign(double d1, double d2)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis{
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis __asm__ __volatile__(
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "andl $0x7fffffff,%0\n\t" /* %0 <-- hi_32(abs(d)) */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "andl $0x80000000,%1\n\t" /* %1[31] <-- sign_bit(d2) */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "orl %1,%0\n\t" /* %0 <-- hi_32(copysign(x,y)) */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis : "+&r" (_HI_WORD(d1)), "+r" (_HI_WORD(d2))
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis :
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis : "cc");
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return (d1);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
7f11fd00fc23e2af7ae21cc8837a2b86380dcfa7Richard Loweextern __GNU_INLINE double
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtisfabs(double d)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis{
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis __asm__ __volatile__("fabs\n\t" : "+t" (d) : : "cc");
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return (d);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
7f11fd00fc23e2af7ae21cc8837a2b86380dcfa7Richard Loweextern __GNU_INLINE float
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtisfabsf(float d)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis{
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis __asm__ __volatile__("fabs\n\t" : "+t" (d) : : "cc");
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return (d);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
7f11fd00fc23e2af7ae21cc8837a2b86380dcfa7Richard Loweextern __GNU_INLINE long double
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtisfabsl(long double d)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis{
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis __asm__ __volatile__("fabs\n\t" : "+t" (d) : : "cc");
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return (d);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
7f11fd00fc23e2af7ae21cc8837a2b86380dcfa7Richard Loweextern __GNU_INLINE int
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtisfinite(double d)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis{
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis int ret = _HI_WORD(d);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis __asm__ __volatile__(
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "notl %0\n\t"
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "andl $0x7ff00000,%0\n\t"
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "negl %0\n\t"
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "shrl $31,%0\n\t"
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis : "+r" (ret)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis :
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis : "cc");
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return (ret);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
7f11fd00fc23e2af7ae21cc8837a2b86380dcfa7Richard Loweextern __GNU_INLINE double
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtisfloor(double d)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis{
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis short rd = __swap87RD(fp_negative);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis __asm__ __volatile__("frndint" : "+t" (d), "+r" (rd) : : "cc");
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis __swap87RD(rd);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return (d);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis/*
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * branchless __isnan
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis * ((0x7ff00000-[((lx|-lx)>>31)&1]|ahx)>>31)&1 = 1 iff x is NaN
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis */
7f11fd00fc23e2af7ae21cc8837a2b86380dcfa7Richard Loweextern __GNU_INLINE int
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtisisnan(double d)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis{
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis int ret;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis __asm__ __volatile__(
7f11fd00fc23e2af7ae21cc8837a2b86380dcfa7Richard Lowe "movl %1,%%ecx\n\t"
7f11fd00fc23e2af7ae21cc8837a2b86380dcfa7Richard Lowe "negl %%ecx\n\t" /* ecx <-- -lo_32(x) */
7f11fd00fc23e2af7ae21cc8837a2b86380dcfa7Richard Lowe "orl %%ecx,%1\n\t"
7f11fd00fc23e2af7ae21cc8837a2b86380dcfa7Richard Lowe "shrl $31,%1\n\t" /* 1 iff lx != 0 */
7f11fd00fc23e2af7ae21cc8837a2b86380dcfa7Richard Lowe "andl $0x7fffffff,%2\n\t" /* ecx <-- hi_32(abs(x)) */
7f11fd00fc23e2af7ae21cc8837a2b86380dcfa7Richard Lowe "orl %2,%1\n\t"
7f11fd00fc23e2af7ae21cc8837a2b86380dcfa7Richard Lowe "subl $0x7ff00000,%1\n\t"
7f11fd00fc23e2af7ae21cc8837a2b86380dcfa7Richard Lowe "negl %1\n\t"
7f11fd00fc23e2af7ae21cc8837a2b86380dcfa7Richard Lowe "shrl $31,%1\n\t"
7f11fd00fc23e2af7ae21cc8837a2b86380dcfa7Richard Lowe : "=r" (ret)
7f11fd00fc23e2af7ae21cc8837a2b86380dcfa7Richard Lowe : "0" (_HI_WORD(d)), "r" (_LO_WORD(d))
7f11fd00fc23e2af7ae21cc8837a2b86380dcfa7Richard Lowe : "ecx");
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return (ret);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
7f11fd00fc23e2af7ae21cc8837a2b86380dcfa7Richard Loweextern __GNU_INLINE int
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtisisnanf(float f)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis{
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis __asm__ __volatile__(
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "andl $0x7fffffff,%0\n\t"
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "negl %0\n\t"
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "addl $0x7f800000,%0\n\t"
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "shrl $31,%0\n\t"
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis : "+r" (f)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis :
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis : "cc");
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return (f);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
7f11fd00fc23e2af7ae21cc8837a2b86380dcfa7Richard Loweextern __GNU_INLINE double
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtisrint(double a) {
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return (__inline_rint(a));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
7f11fd00fc23e2af7ae21cc8837a2b86380dcfa7Richard Loweextern __GNU_INLINE double
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtisscalbn(double d, int n)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis{
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis double dummy;
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis __asm__ __volatile__(
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "fildl %2\n\t" /* Convert N to extended */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "fxch\n\t"
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "fscale\n\t"
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis : "+t" (d), "=u" (dummy)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis : "m" (n)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis : "cc");
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return (d);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
7f11fd00fc23e2af7ae21cc8837a2b86380dcfa7Richard Loweextern __GNU_INLINE int
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtissignbit(double d)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis{
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return (_HI_WORD(d) >> 31);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
7f11fd00fc23e2af7ae21cc8837a2b86380dcfa7Richard Loweextern __GNU_INLINE int
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtissignbitf(float f)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis{
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return ((*(uint32_t *)&f) >> 31);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
7f11fd00fc23e2af7ae21cc8837a2b86380dcfa7Richard Loweextern __GNU_INLINE double
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtissqrt(double d)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis{
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return (__inline_sqrt(d));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
7f11fd00fc23e2af7ae21cc8837a2b86380dcfa7Richard Loweextern __GNU_INLINE float
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtissqrtf(float f)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis{
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return (__inline_sqrtf(f));
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
7f11fd00fc23e2af7ae21cc8837a2b86380dcfa7Richard Loweextern __GNU_INLINE long double
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtissqrtl(long double ld)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis{
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis __asm__ __volatile__("fsqrt" : "+t" (ld) : : "cc");
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return (ld);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
7f11fd00fc23e2af7ae21cc8837a2b86380dcfa7Richard Loweextern __GNU_INLINE int
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtisisnanl(long double ld)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis{
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis int ret = _HIER_WORD(ld);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis __asm__ __volatile__(
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "andl $0x00007fff,%0\n\t"
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "jz 1f\n\t" /* jump if exp is all 0 */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "xorl $0x00007fff,%0\n\t"
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "jz 2f\n\t" /* jump if exp is all 1 */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "testl $0x80000000,%1\n\t"
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "jz 3f\n\t" /* jump if leading bit is 0 */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "xorl %0,%0\n\t"
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "jmp 1f\n\t"
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "2:\n\t" /* note that %0 = 0 from before */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "cmpl $0x80000000,%1\n\t" /* what is first half of significand? */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "jnz 3f\n\t" /* jump if not equal to 0x80000000 */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "testl $0xffffffff,%2\n\t" /* is second half of significand 0? */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "jnz 3f\n\t" /* jump if not equal to 0 */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "jmp 1f\n\t"
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "3:\n\t"
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "movl $1,%0\n\t"
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis "1:\n\t"
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis : "+&r" (ret)
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis : "r" (_HI_WORD(ld)), "r" (_LO_WORD(ld))
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis : "cc");
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis return (ret);
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#ifdef __cplusplus
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis}
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#endif
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#endif /* __GNUC__ */
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis
25c28e83beb90e7c80452a7c818c5e6f73a07dc8Piotr Jasiukajtis#endif /* _LIBM_INLINES_H */