| 1 |
#ifndef FP_EMULATION_H_INCLUDED |
| 2 |
#define FP_EMULATION_H_INCLUDED |
| 3 |
|
| 4 |
#include <math.h> |
| 5 |
|
| 6 |
int is_snan(float x) |
| 7 |
{ |
| 8 |
union32f_ud fb; |
| 9 |
fb.f = x; |
| 10 |
return __builtin_isnan(x) && (fb.u & 0x00400000) == 0; |
| 11 |
} |
| 12 |
|
| 13 |
int is_qnan(float x) |
| 14 |
{ |
| 15 |
return __builtin_isnan(x) && !is_snan(x); |
| 16 |
} |
| 17 |
|
| 18 |
#define INTEL_SSE_MATH_OP(op, a, b) \ |
| 19 |
({ \ |
| 20 |
union32f_ud tmp; \ |
| 21 |
float result; \ |
| 22 |
if (is_qnan(a)) \ |
| 23 |
result = a; \ |
| 24 |
else if (is_snan(a)) \ |
| 25 |
{ \ |
| 26 |
tmp.f = a; tmp.u |= 0x400000; result = tmp.f; \ |
| 27 |
} else if (is_snan(b)) \ |
| 28 |
{ \ |
| 29 |
tmp.f = b; tmp.u |= 0x400000; result = tmp.f; \ |
| 30 |
} else if (is_qnan(b)) \ |
| 31 |
result = b; \ |
| 32 |
else \ |
| 33 |
result = a op b; \ |
| 34 |
result; \ |
| 35 |
}) |
| 36 |
|
| 37 |
float |
| 38 |
intel_sse_math_add(float a, float b) |
| 39 |
{ |
| 40 |
return INTEL_SSE_MATH_OP(+, a, b); |
| 41 |
} |
| 42 |
|
| 43 |
float |
| 44 |
intel_sse_math_sub(float a, float b) |
| 45 |
{ |
| 46 |
return INTEL_SSE_MATH_OP(-, a, b); |
| 47 |
} |
| 48 |
|
| 49 |
float |
| 50 |
intel_sse_math_mul(float a, float b) |
| 51 |
{ |
| 52 |
return INTEL_SSE_MATH_OP(*, a, b); |
| 53 |
} |
| 54 |
|
| 55 |
float |
| 56 |
intel_sse_math_div(float a, float b) |
| 57 |
{ |
| 58 |
return INTEL_SSE_MATH_OP(/, a, b); |
| 59 |
} |
| 60 |
|
| 61 |
/* +-3 == +-inf, |
| 62 |
+-2 == +-Nan, use -2 only, |
| 63 |
+-1 == +- normal number, |
| 64 |
0 == undefined/not intialized */ |
| 65 |
|
| 66 |
int |
| 67 |
state_handler(int src0, int src1, __int128 a, __int128 b, char op) |
| 68 |
{ |
| 69 |
/* Nan */ |
| 70 |
if (src0 == -2 || src1 == -2) |
| 71 |
return -2; |
| 72 |
|
| 73 |
if (abs(src0) == 3 || abs(src1) == 3) |
| 74 |
{ |
| 75 |
/* +INF + +INF = +INF, -INF + -INF = -INF */ |
| 76 |
if (src0 == src1) |
| 77 |
return src0; |
| 78 |
|
| 79 |
/* Positive result */ |
| 80 |
if ((op == '*' && ((src0 < 0 && b < 0) || (src1 < 0 && a < 0))) || |
| 81 |
(op == '*' && ((src0 > 0 && b > 0) || (src1 > 0 && a > 0)))) |
| 82 |
return 3; |
| 83 |
|
| 84 |
/* -INF * (positive normal) = -INF */ |
| 85 |
if (op == '*' && ((src0 < 0 || src1 < 0) && (a >= 0 && b >= 0))) |
| 86 |
return -3; |
| 87 |
|
| 88 |
/* INF * 0 = NaN */ |
| 89 |
if (a == 0 || b == 0) |
| 90 |
return -2; |
| 91 |
|
| 92 |
/* -INF + +INF = NaN, else +INF or -INF */ |
| 93 |
return (op == '+' && src0 != src1) ? -2 : 3 * ((src0 / 3) + (src1 / 3)); |
| 94 |
} |
| 95 |
|
| 96 |
/* Normal number case */ |
| 97 |
__int128 result = op == '+' ? a + b : a * b; |
| 98 |
return result < 0 ? -1 : 1; |
| 99 |
} |
| 100 |
|
| 101 |
int |
| 102 |
state_handler_float (float src) |
| 103 |
{ |
| 104 |
if (isnan (src)) |
| 105 |
return -2; |
| 106 |
else if (isinf (src)) |
| 107 |
return src > 0 ? 3 : -3; |
| 108 |
else |
| 109 |
return src >= 0 ? 1 : -1; |
| 110 |
} |
| 111 |
|
| 112 |
#endif |