xref: /freebsd/lib/msun/src/s_fmaf.c (revision 4d846d260e2b9a3d4d0a701462568268cbfe7a5b)
1d5580d09SDavid Schultz /*-
2*4d846d26SWarner Losh  * SPDX-License-Identifier: BSD-2-Clause
35e53a4f9SPedro F. Giffuni  *
4ec950830SDavid Schultz  * Copyright (c) 2005-2011 David Schultz <das@FreeBSD.ORG>
5d5580d09SDavid Schultz  * All rights reserved.
6d5580d09SDavid Schultz  *
7d5580d09SDavid Schultz  * Redistribution and use in source and binary forms, with or without
8d5580d09SDavid Schultz  * modification, are permitted provided that the following conditions
9d5580d09SDavid Schultz  * are met:
10d5580d09SDavid Schultz  * 1. Redistributions of source code must retain the above copyright
11d5580d09SDavid Schultz  *    notice, this list of conditions and the following disclaimer.
12d5580d09SDavid Schultz  * 2. Redistributions in binary form must reproduce the above copyright
13d5580d09SDavid Schultz  *    notice, this list of conditions and the following disclaimer in the
14d5580d09SDavid Schultz  *    documentation and/or other materials provided with the distribution.
15d5580d09SDavid Schultz  *
16d5580d09SDavid Schultz  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
17d5580d09SDavid Schultz  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
18d5580d09SDavid Schultz  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
19d5580d09SDavid Schultz  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
20d5580d09SDavid Schultz  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
21d5580d09SDavid Schultz  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
22d5580d09SDavid Schultz  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
23d5580d09SDavid Schultz  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
24d5580d09SDavid Schultz  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
25d5580d09SDavid Schultz  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
26d5580d09SDavid Schultz  * SUCH DAMAGE.
27d5580d09SDavid Schultz  */
28d5580d09SDavid Schultz 
29d5580d09SDavid Schultz #include <sys/cdefs.h>
30d5580d09SDavid Schultz __FBSDID("$FreeBSD$");
31d5580d09SDavid Schultz 
32ec950830SDavid Schultz #include <fenv.h>
33ec950830SDavid Schultz 
34a1af0d70SDavid Schultz #include "math.h"
35ec950830SDavid Schultz #include "math_private.h"
36a1af0d70SDavid Schultz 
37b2e84316SAndrew Turner #ifdef USE_BUILTIN_FMAF
38b2e84316SAndrew Turner float
39b2e84316SAndrew Turner fmaf(float x, float y, float z)
40b2e84316SAndrew Turner {
41b2e84316SAndrew Turner 	return (__builtin_fmaf(x, y, z));
42b2e84316SAndrew Turner }
43b2e84316SAndrew Turner #else
44d5580d09SDavid Schultz /*
45d5580d09SDavid Schultz  * Fused multiply-add: Compute x * y + z with a single rounding error.
46d5580d09SDavid Schultz  *
47d5580d09SDavid Schultz  * A double has more than twice as much precision than a float, so
48ec950830SDavid Schultz  * direct double-precision arithmetic suffices, except where double
49ec950830SDavid Schultz  * rounding occurs.
50d5580d09SDavid Schultz  */
51d5580d09SDavid Schultz float
52d5580d09SDavid Schultz fmaf(float x, float y, float z)
53d5580d09SDavid Schultz {
54ec950830SDavid Schultz 	double xy, result;
55ec950830SDavid Schultz 	uint32_t hr, lr;
56d5580d09SDavid Schultz 
57ec950830SDavid Schultz 	xy = (double)x * y;
58ec950830SDavid Schultz 	result = xy + z;
59ec950830SDavid Schultz 	EXTRACT_WORDS(hr, lr, result);
60ec950830SDavid Schultz 	/* Common case: The double precision result is fine. */
61ec950830SDavid Schultz 	if ((lr & 0x1fffffff) != 0x10000000 ||	/* not a halfway case */
62ec950830SDavid Schultz 	    (hr & 0x7ff00000) == 0x7ff00000 ||	/* NaN */
63ec950830SDavid Schultz 	    result - xy == z ||			/* exact */
64ec950830SDavid Schultz 	    fegetround() != FE_TONEAREST)	/* not round-to-nearest */
65ec950830SDavid Schultz 		return (result);
66ec950830SDavid Schultz 
67ec950830SDavid Schultz 	/*
68ec950830SDavid Schultz 	 * If result is inexact, and exactly halfway between two float values,
69ec950830SDavid Schultz 	 * we need to adjust the low-order bit in the direction of the error.
70ec950830SDavid Schultz 	 */
71ec950830SDavid Schultz 	fesetround(FE_TOWARDZERO);
72ec950830SDavid Schultz 	volatile double vxy = xy;  /* XXX work around gcc CSE bug */
73ec950830SDavid Schultz 	double adjusted_result = vxy + z;
74ec950830SDavid Schultz 	fesetround(FE_TONEAREST);
75ec950830SDavid Schultz 	if (result == adjusted_result)
76ec950830SDavid Schultz 		SET_LOW_WORD(adjusted_result, lr + 1);
77ec950830SDavid Schultz 	return (adjusted_result);
78d5580d09SDavid Schultz }
79b2e84316SAndrew Turner #endif /* !USE_BUILTIN_FMAF */
80