mirror of
https://github.com/autc04/Retro68.git
synced 2024-12-04 16:50:57 +00:00
171 lines
5.3 KiB
C
171 lines
5.3 KiB
C
|
/*
|
||
|
(C) Copyright 2001,2006,
|
||
|
International Business Machines Corporation,
|
||
|
Sony Computer Entertainment, Incorporated,
|
||
|
Toshiba Corporation,
|
||
|
|
||
|
All rights reserved.
|
||
|
|
||
|
Redistribution and use in source and binary forms, with or without
|
||
|
modification, are permitted provided that the following conditions are met:
|
||
|
|
||
|
* Redistributions of source code must retain the above copyright notice,
|
||
|
this list of conditions and the following disclaimer.
|
||
|
* Redistributions in binary form must reproduce the above copyright
|
||
|
notice, this list of conditions and the following disclaimer in the
|
||
|
documentation and/or other materials provided with the distribution.
|
||
|
* Neither the names of the copyright holders nor the names of their
|
||
|
contributors may be used to endorse or promote products derived from this
|
||
|
software without specific prior written permission.
|
||
|
|
||
|
THIS SOFTWARE IS PROVIDED BY THE COPYRIGHT HOLDERS AND CONTRIBUTORS "AS
|
||
|
IS" AND ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED
|
||
|
TO, THE IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A
|
||
|
PARTICULAR PURPOSE ARE DISCLAIMED. IN NO EVENT SHALL THE COPYRIGHT OWNER
|
||
|
OR CONTRIBUTORS BE LIABLE FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL,
|
||
|
EXEMPLARY, OR CONSEQUENTIAL DAMAGES (INCLUDING, BUT NOT LIMITED TO,
|
||
|
PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; LOSS OF USE, DATA, OR
|
||
|
PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND ON ANY THEORY OF
|
||
|
LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT (INCLUDING
|
||
|
NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS
|
||
|
SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE.
|
||
|
*/
|
||
|
#ifndef _FMODF_H_
|
||
|
#define _FMODF_H_ 1
|
||
|
|
||
|
#include <errno.h>
|
||
|
#include <spu_intrinsics.h>
|
||
|
#include "headers/vec_literal.h"
|
||
|
|
||
|
#include "fabsf.h"
|
||
|
|
||
|
/*
|
||
|
* FUNCTION
|
||
|
* float _fmodf(float x, float y)
|
||
|
*
|
||
|
* DESCRIPTION
|
||
|
* The _fmodf subroutine computes the remainder of
|
||
|
* dividing x by y. The return value is x - n*y, where n is
|
||
|
* the quotient of x/y, rounded towards zero.
|
||
|
*
|
||
|
* The full range form (default) provides fmod computation on
|
||
|
* all IEEE floating point values (excluding floating overflow
|
||
|
* or underflow).
|
||
|
*
|
||
|
* The limited range form (selected by defining FMODF_INTEGER_RANGE)
|
||
|
* compute fmod of all floating-point x/y values in the 32-bit
|
||
|
* signed integer range. Values outside this range get clamped.
|
||
|
*/
|
||
|
|
||
|
static __inline float _fmodf(float x, float y)
|
||
|
{
|
||
|
#ifdef FMODF_INTEGER_RANGE
|
||
|
/* 32-BIT INTEGER DYNAMIC RANGE
|
||
|
*/
|
||
|
float abs_y;
|
||
|
float quotient;
|
||
|
|
||
|
abs_y = _fabsf(y);
|
||
|
quotient = x/abs_y;
|
||
|
|
||
|
return (abs_y*(quotient - ((float)((int)quotient))));
|
||
|
|
||
|
#else /* !FMODF_INTEGER_RANGE */
|
||
|
/* FULL FLOATING-POINT RANGE
|
||
|
*/
|
||
|
int n;
|
||
|
vec_uint4 vx, vy, z;
|
||
|
vec_uint4 abs_x, abs_y;
|
||
|
vec_uint4 exp_x, exp_y;
|
||
|
vec_uint4 zero_x, zero_y;
|
||
|
vec_uint4 logb_x, logb_y;
|
||
|
vec_uint4 mant_x, mant_y;
|
||
|
vec_uint4 result, result0, resultx, cnt, sign;
|
||
|
vec_uint4 sign_mask = VEC_SPLAT_U32(0x80000000);
|
||
|
vec_uint4 implied_1 = VEC_SPLAT_U32(0x00800000);
|
||
|
vec_uint4 mant_mask = VEC_SPLAT_U32(0x007FFFFF);
|
||
|
vec_uint4 domain;
|
||
|
vec_int4 verrno;
|
||
|
vec_float4 vc = { 0.0, 0.0, 0.0, 0.0 };
|
||
|
vec_int4 fail = { EDOM, EDOM, EDOM, EDOM };
|
||
|
|
||
|
vx = (vec_uint4)spu_promote(x, 0);
|
||
|
vy = (vec_uint4)spu_promote(y, 0);
|
||
|
|
||
|
abs_x = spu_andc(vx, sign_mask);
|
||
|
abs_y = spu_andc(vy, sign_mask);
|
||
|
|
||
|
sign = spu_and(vx, sign_mask);
|
||
|
|
||
|
/* Determine ilogb of abs_x and abs_y and
|
||
|
* extract the mantissas (mant_x, mant_y)
|
||
|
*/
|
||
|
exp_x = spu_rlmask(abs_x, -23);
|
||
|
exp_y = spu_rlmask(abs_y, -23);
|
||
|
|
||
|
resultx = spu_cmpgt(abs_y, abs_x);
|
||
|
|
||
|
zero_x = spu_cmpeq(exp_x, 0);
|
||
|
zero_y = spu_cmpeq(exp_y, 0);
|
||
|
|
||
|
logb_x = spu_add(exp_x, -127);
|
||
|
logb_y = spu_add(exp_y, -127);
|
||
|
|
||
|
mant_x = spu_andc(spu_sel(implied_1, abs_x, mant_mask), zero_x);
|
||
|
mant_y = spu_andc(spu_sel(implied_1, abs_y, mant_mask), zero_y);
|
||
|
|
||
|
/* Compute fixed point fmod of mant_x and mant_y. Set the flag,
|
||
|
* result0, to all ones if we detect that the final result is
|
||
|
* ever 0.
|
||
|
*/
|
||
|
result0 = spu_or(zero_x, zero_y);
|
||
|
|
||
|
n = spu_extract(spu_sub(logb_x, logb_y), 0);
|
||
|
|
||
|
while (n-- > 0) {
|
||
|
z = spu_sub(mant_x, mant_y);
|
||
|
|
||
|
result0 = spu_or(spu_cmpeq(z, 0), result0);
|
||
|
|
||
|
mant_x = spu_sel(spu_add(mant_x, mant_x), spu_add(z, z),
|
||
|
spu_cmpgt((vec_int4)z, -1));
|
||
|
}
|
||
|
|
||
|
z = spu_sub(mant_x, mant_y);
|
||
|
mant_x = spu_sel(mant_x, z, spu_cmpgt((vec_int4)z, -1));
|
||
|
|
||
|
result0 = spu_or(spu_cmpeq(mant_x, 0), result0);
|
||
|
|
||
|
/* Convert the result back to floating point and restore
|
||
|
* the sign. If we flagged the result to be zero (result0),
|
||
|
* zero it. If we flagged the result to equal its input x,
|
||
|
* (resultx) then return x.
|
||
|
*/
|
||
|
cnt = spu_add(spu_cntlz(mant_x), -8);
|
||
|
|
||
|
mant_x = spu_rl(spu_andc(mant_x, implied_1), (vec_int4)cnt);
|
||
|
|
||
|
exp_y = spu_sub(exp_y, cnt);
|
||
|
result0 = spu_orc(result0, spu_cmpgt((vec_int4)exp_y, 0)); /* zero denorm results */
|
||
|
exp_y = spu_rl(exp_y, 23);
|
||
|
|
||
|
|
||
|
result = spu_sel(exp_y, spu_or(sign, mant_x), VEC_SPLAT_U32(0x807FFFFF));
|
||
|
|
||
|
result = spu_sel(spu_andc(result, spu_rlmask(result0, -1)), vx,
|
||
|
resultx);
|
||
|
|
||
|
#ifndef _IEEE_LIBM
|
||
|
/*
|
||
|
* If y is zero, set errno to EDOM
|
||
|
*/
|
||
|
domain = spu_cmpeq(vc, (vec_float4) vy);
|
||
|
verrno = spu_splats(errno);
|
||
|
errno = spu_extract(spu_sel(verrno, fail, (vector unsigned int) domain), 0);
|
||
|
#endif
|
||
|
|
||
|
return (spu_extract((vec_float4)result, 0));
|
||
|
#endif /* FMODF_INTEGER_RANGE */
|
||
|
}
|
||
|
#endif /* _FMODF_H_ */
|