mirror of
https://github.com/jart/cosmopolitan.git
synced 2025-01-31 11:37:35 +00:00
104 lines
4.4 KiB
C
104 lines
4.4 KiB
C
/*-*- mode:c;indent-tabs-mode:nil;c-basic-offset:2;tab-width:8;coding:utf-8 -*-│
|
|
│vi: set net ft=c ts=2 sts=2 sw=2 fenc=utf-8 :vi│
|
|
╚──────────────────────────────────────────────────────────────────────────────╝
|
|
│ │
|
|
│ Optimized Routines │
|
|
│ Copyright (c) 1999-2022, Arm Limited. │
|
|
│ │
|
|
│ Permission is hereby granted, free of charge, to any person obtaining │
|
|
│ a copy of this software and associated documentation files (the │
|
|
│ "Software"), to deal in the Software without restriction, including │
|
|
│ without limitation the rights to use, copy, modify, merge, publish, │
|
|
│ distribute, sublicense, and/or sell copies of the Software, and to │
|
|
│ permit persons to whom the Software is furnished to do so, subject to │
|
|
│ the following conditions: │
|
|
│ │
|
|
│ The above copyright notice and this permission notice shall be │
|
|
│ included in all copies or substantial portions of the Software. │
|
|
│ │
|
|
│ THE SOFTWARE IS PROVIDED "AS IS", WITHOUT WARRANTY OF ANY KIND, │
|
|
│ EXPRESS OR IMPLIED, INCLUDING BUT NOT LIMITED TO THE WARRANTIES OF │
|
|
│ MERCHANTABILITY, FITNESS FOR A PARTICULAR PURPOSE AND NONINFRINGEMENT. │
|
|
│ IN NO EVENT SHALL THE AUTHORS OR COPYRIGHT HOLDERS BE LIABLE FOR ANY │
|
|
│ CLAIM, DAMAGES OR OTHER LIABILITY, WHETHER IN AN ACTION OF CONTRACT, │
|
|
│ TORT OR OTHERWISE, ARISING FROM, OUT OF OR IN CONNECTION WITH THE │
|
|
│ SOFTWARE OR THE USE OR OTHER DEALINGS IN THE SOFTWARE. │
|
|
│ │
|
|
╚─────────────────────────────────────────────────────────────────────────────*/
|
|
#include "libc/intrin/likely.h"
|
|
#include "libc/math.h"
|
|
#include "libc/tinymath/sincosf.internal.h"
|
|
|
|
asm(".ident\t\"\\n\\n\
|
|
Optimized Routines (MIT License)\\n\
|
|
Copyright 2022 ARM Limited\"");
|
|
asm(".include \"libc/disclaimer.inc\"");
|
|
// clang-format off
|
|
|
|
/* Fast sincosf implementation. Worst-case ULP is 0.5607, maximum relative
|
|
error is 0.5303 * 2^-23. A single-step range reduction is used for
|
|
small values. Large inputs have their range reduced using fast integer
|
|
arithmetic. */
|
|
void
|
|
sincosf (float y, float *sinp, float *cosp)
|
|
{
|
|
double x = y;
|
|
double s;
|
|
int n;
|
|
const sincos_t *p = &__sincosf_table[0];
|
|
|
|
if (abstop12 (y) < abstop12 (pio4f))
|
|
{
|
|
double x2 = x * x;
|
|
|
|
if (UNLIKELY (abstop12 (y) < abstop12 (0x1p-12f)))
|
|
{
|
|
if (UNLIKELY (abstop12 (y) < abstop12 (0x1p-126f)))
|
|
/* Force underflow for tiny y. */
|
|
FORCE_EVAL (x2);
|
|
*sinp = y;
|
|
*cosp = 1.0f;
|
|
return;
|
|
}
|
|
|
|
sincosf_poly (x, x2, p, 0, sinp, cosp);
|
|
}
|
|
else if (abstop12 (y) < abstop12 (120.0f))
|
|
{
|
|
x = reduce_fast (x, p, &n);
|
|
|
|
/* Setup the signs for sin and cos. */
|
|
s = p->sign[n & 3];
|
|
|
|
if (n & 2)
|
|
p = &__sincosf_table[1];
|
|
|
|
sincosf_poly (x * s, x * x, p, n, sinp, cosp);
|
|
}
|
|
else if (LIKELY (abstop12 (y) < abstop12 (INFINITY)))
|
|
{
|
|
uint32_t xi = asuint (y);
|
|
int sign = xi >> 31;
|
|
|
|
x = reduce_large (xi, &n);
|
|
|
|
/* Setup signs for sin and cos - include original sign. */
|
|
s = p->sign[(n + sign) & 3];
|
|
|
|
if ((n + sign) & 2)
|
|
p = &__sincosf_table[1];
|
|
|
|
sincosf_poly (x * s, x * x, p, n, sinp, cosp);
|
|
}
|
|
else
|
|
{
|
|
/* Return NaN if Inf or NaN for both sin and cos. */
|
|
*sinp = *cosp = y - y;
|
|
#if WANT_ERRNO
|
|
/* Needed to set errno for +-Inf, the add is a hack to work
|
|
around a gcc register allocation issue: just passing y
|
|
affects code generation in the fast path. */
|
|
__math_invalidf (y + y);
|
|
#endif
|
|
}
|
|
}
|