1 /*
2 * SPDX-License-Identifier: BSD-3-Clause
3 *
4 * Copyright © 2022 Keith Packard
5 *
6 * Redistribution and use in source and binary forms, with or without
7 * modification, are permitted provided that the following conditions
8 * are met:
9 *
10 * 1. Redistributions of source code must retain the above copyright
11 * notice, this list of conditions and the following disclaimer.
12 *
13 * 2. Redistributions in binary form must reproduce the above
14 * copyright notice, this list of conditions and the following
15 * disclaimer in the documentation and/or other materials provided
16 * with the distribution.
17 *
18 * 3. Neither the name of the copyright holder nor the names of its
19 * contributors may be used to endorse or promote products derived
20 * from this software without specific prior written permission.
21 *
22 * THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS
23 * "AS IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT
24 * LIMITED TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS
25 * FOR A PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE
26 * COPYRIGHT HOLDER OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT,
27 * INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES
28 * (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR
29 * SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
30 * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT,
31 * STRICT LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE)
32 * ARISING IN ANY WAY OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED
33 * OF THE POSSIBILITY OF SUCH DAMAGE.
34 */
35
36 #ifndef _MACHINE_MATH_H_
37 #define _MACHINE_MATH_H_
38
39 #if __ARM_FP & 0x8
40 #define _HAVE_FAST_FMA 1
41 #endif
42
43 #if __ARM_FP & 0x4
44 #define _HAVE_FAST_FMAF 1
45 #endif
46
47 #ifdef __declare_extern_inline
48
49 #ifdef _WANT_MATH_ERRNO
50 #include <errno.h>
51 #endif
52
53 #if __ARM_FP & 0x8
54
55 __declare_extern_inline(double)
sqrt(double x)56 sqrt (double x)
57 {
58 double result;
59 #ifdef _WANT_MATH_ERRNO
60 if (isless(x, 0.0))
61 errno = EDOM;
62 #endif
63 __asm__ __volatile__ ("fsqrt\t%d0, %d1" : "=w" (result) : "w" (x));
64 return result;
65 }
66
67 __declare_extern_inline(double)
fma(double x,double y,double z)68 fma (double x, double y, double z)
69 {
70 double result;
71 __asm__ __volatile__ ("fmadd\t%d0, %d1, %d2, %d3" : "=w" (result) : "w" (x), "w" (y), "w" (z));
72 return result;
73 }
74
75 #endif /* __ARM_FP & 0x8 */
76
77 #if __ARM_FP & 0x4
78 __declare_extern_inline(float)
sqrtf(float x)79 sqrtf (float x)
80 {
81 float result;
82 #ifdef _WANT_MATH_ERRNO
83 if (isless(x, 0.0f))
84 errno = EDOM;
85 #endif
86 __asm__ __volatile__ ("fsqrt\t%s0, %s1" : "=w" (result) : "w" (x));
87 return result;
88 }
89
90 __declare_extern_inline(float)
fmaf(float x,float y,float z)91 fmaf (float x, float y, float z)
92 {
93 float result;
94 __asm__ __volatile__ ("fmadd\t%s0, %s1, %s2, %s3" : "=w" (result) : "w" (x), "w" (y), "w" (z));
95 return result;
96 }
97
98 #endif /* __ARM_FP & 0x4 */
99 #endif
100
101 #endif /* _MACHINE_MATH_H_ */
102
