1206 lines
28 KiB
C
1206 lines
28 KiB
C
/* This is a software fixed-point library.
|
|
Copyright (C) 2007-2021 Free Software Foundation, Inc.
|
|
|
|
This file is part of GCC.
|
|
|
|
GCC is free software; you can redistribute it and/or modify it under
|
|
the terms of the GNU General Public License as published by the Free
|
|
Software Foundation; either version 3, or (at your option) any later
|
|
version.
|
|
|
|
GCC is distributed in the hope that it will be useful, but WITHOUT ANY
|
|
WARRANTY; without even the implied warranty of MERCHANTABILITY or
|
|
FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
|
|
for more details.
|
|
|
|
Under Section 7 of GPL version 3, you are granted additional
|
|
permissions described in the GCC Runtime Library Exception, version
|
|
3.1, as published by the Free Software Foundation.
|
|
|
|
You should have received a copy of the GNU General Public License and
|
|
a copy of the GCC Runtime Library Exception along with this program;
|
|
see the files COPYING3 and COPYING.RUNTIME respectively. If not, see
|
|
<http://www.gnu.org/licenses/>. */
|
|
|
|
/* This implements fixed-point arithmetic.
|
|
|
|
Contributed by Chao-ying Fu <fu@mips.com>. */
|
|
|
|
/* To use this file, we need to define one of the following:
|
|
QQ_MODE, UQQ_MODE, HQ_MODE, UHQ_MODE, SQ_MODE, USQ_MODE, DQ_MODE, UDQ_MODE,
|
|
TQ_MODE, UTQ_MODE, HA_MODE, UHA_MODE, SA_MODE, USA_MODE, DA_MODE, UDA_MODE,
|
|
TA_MODE, UTA_MODE.
|
|
Then, all operators for this machine mode will be created.
|
|
|
|
Or, we need to define FROM_* TO_* for conversions from one mode to another
|
|
mode. The mode could be one of the following:
|
|
Fract: QQ, UQQ, HQ, UHQ, SQ, USQ, DQ, UDQ, TQ, UTQ
|
|
Accum: HA, UHA, SA, USA, DA, UDA, TA, UTA
|
|
Signed integer: QI, HI, SI, DI, TI
|
|
Unsigned integer: UQI, UHI, USI, UDI, UTI
|
|
Floating-point: SF, DF
|
|
Ex: If we define FROM_QQ and TO_SI, the conversion from QQ to SI is
|
|
generated. */
|
|
|
|
#include "tconfig.h"
|
|
#include "tsystem.h"
|
|
#include "coretypes.h"
|
|
#include "tm.h"
|
|
#include "libgcc_tm.h"
|
|
|
|
#ifndef MIN_UNITS_PER_WORD
|
|
#define MIN_UNITS_PER_WORD UNITS_PER_WORD
|
|
#endif
|
|
|
|
#include "fixed-bit.h"
|
|
|
|
#if defined(FIXED_ADD) && defined(L_add)
|
|
FIXED_C_TYPE
|
|
FIXED_ADD (FIXED_C_TYPE a, FIXED_C_TYPE b)
|
|
{
|
|
FIXED_C_TYPE c;
|
|
INT_C_TYPE x, y, z;
|
|
memcpy (&x, &a, FIXED_SIZE);
|
|
memcpy (&y, &b, FIXED_SIZE);
|
|
z = x + y;
|
|
#if HAVE_PADDING_BITS
|
|
z = z << PADDING_BITS;
|
|
z = z >> PADDING_BITS;
|
|
#endif
|
|
memcpy (&c, &z, FIXED_SIZE);
|
|
return c;
|
|
}
|
|
#endif /* FIXED_ADD */
|
|
|
|
#if defined(FIXED_SSADD) && defined(L_ssadd)
|
|
FIXED_C_TYPE
|
|
FIXED_SSADD (FIXED_C_TYPE a, FIXED_C_TYPE b)
|
|
{
|
|
FIXED_C_TYPE c;
|
|
INT_C_TYPE x, y, z;
|
|
memcpy (&x, &a, FIXED_SIZE);
|
|
memcpy (&y, &b, FIXED_SIZE);
|
|
z = x + (UINT_C_TYPE) y;
|
|
if ((((x ^ y) >> I_F_BITS) & 1) == 0)
|
|
{
|
|
if (((z ^ x) >> I_F_BITS) & 1)
|
|
{
|
|
z = ((UINT_C_TYPE) 1) << I_F_BITS;
|
|
if (x >= 0)
|
|
z -= (UINT_C_TYPE) 1;
|
|
}
|
|
}
|
|
#if HAVE_PADDING_BITS
|
|
z = z << PADDING_BITS;
|
|
z = z >> PADDING_BITS;
|
|
#endif
|
|
memcpy (&c, &z, FIXED_SIZE);
|
|
return c;
|
|
}
|
|
#endif /* FIXED_SSADD */
|
|
|
|
#if defined(FIXED_USADD) && defined(L_usadd)
|
|
FIXED_C_TYPE
|
|
FIXED_USADD (FIXED_C_TYPE a, FIXED_C_TYPE b)
|
|
{
|
|
FIXED_C_TYPE c;
|
|
INT_C_TYPE x, y, z;
|
|
memcpy (&x, &a, FIXED_SIZE);
|
|
memcpy (&y, &b, FIXED_SIZE);
|
|
z = x + y;
|
|
#if HAVE_PADDING_BITS
|
|
z = z << PADDING_BITS;
|
|
z = z >> PADDING_BITS;
|
|
#endif
|
|
if (z < x || z < y) /* max */
|
|
{
|
|
z = -1;
|
|
#if HAVE_PADDING_BITS
|
|
z = z << PADDING_BITS;
|
|
z = z >> PADDING_BITS;
|
|
#endif
|
|
}
|
|
memcpy (&c, &z, FIXED_SIZE);
|
|
return c;
|
|
}
|
|
#endif /* FIXED_USADD */
|
|
|
|
#if defined(FIXED_SUB) && defined(L_sub)
|
|
FIXED_C_TYPE
|
|
FIXED_SUB (FIXED_C_TYPE a, FIXED_C_TYPE b)
|
|
{
|
|
FIXED_C_TYPE c;
|
|
INT_C_TYPE x, y, z;
|
|
memcpy (&x, &a, FIXED_SIZE);
|
|
memcpy (&y, &b, FIXED_SIZE);
|
|
z = x - y;
|
|
#if HAVE_PADDING_BITS
|
|
z = z << PADDING_BITS;
|
|
z = z >> PADDING_BITS;
|
|
#endif
|
|
memcpy (&c, &z, FIXED_SIZE);
|
|
return c;
|
|
}
|
|
#endif /* FIXED_SUB */
|
|
|
|
#if defined(FIXED_SSSUB) && defined(L_sssub)
|
|
FIXED_C_TYPE
|
|
FIXED_SSSUB (FIXED_C_TYPE a, FIXED_C_TYPE b)
|
|
{
|
|
FIXED_C_TYPE c;
|
|
INT_C_TYPE x, y, z;
|
|
memcpy (&x, &a, FIXED_SIZE);
|
|
memcpy (&y, &b, FIXED_SIZE);
|
|
z = x - (UINT_C_TYPE) y;
|
|
if (((x ^ y) >> I_F_BITS) & 1)
|
|
{
|
|
if (((z ^ x) >> I_F_BITS) & 1)
|
|
{
|
|
z = ((UINT_C_TYPE) 1) << I_F_BITS;
|
|
if (x >= 0)
|
|
z -= (UINT_C_TYPE) 1;
|
|
}
|
|
}
|
|
#if HAVE_PADDING_BITS
|
|
z = z << PADDING_BITS;
|
|
z = z >> PADDING_BITS;
|
|
#endif
|
|
memcpy (&c, &z, FIXED_SIZE);
|
|
return c;
|
|
}
|
|
#endif /* FIXED_SSSUB */
|
|
|
|
#if defined(FIXED_USSUB) && defined(L_ussub)
|
|
FIXED_C_TYPE
|
|
FIXED_USSUB (FIXED_C_TYPE a, FIXED_C_TYPE b)
|
|
{
|
|
FIXED_C_TYPE c;
|
|
INT_C_TYPE x, y, z;
|
|
memcpy (&x, &a, FIXED_SIZE);
|
|
memcpy (&y, &b, FIXED_SIZE);
|
|
z = x - y;
|
|
if (x < y)
|
|
z = 0;
|
|
#if HAVE_PADDING_BITS
|
|
z = z << PADDING_BITS;
|
|
z = z >> PADDING_BITS;
|
|
#endif
|
|
memcpy (&c, &z, FIXED_SIZE);
|
|
return c;
|
|
}
|
|
#endif /* FIXED_USSUB */
|
|
|
|
#if defined(FIXED_SATURATE1) && defined(L_saturate1)
|
|
void
|
|
FIXED_SATURATE1 (DINT_C_TYPE *a)
|
|
{
|
|
DINT_C_TYPE max, min;
|
|
max = (DINT_C_TYPE)1 << I_F_BITS;
|
|
max = max - 1;
|
|
#if MODE_UNSIGNED == 0
|
|
min = (DINT_C_TYPE)1 << (2 * FIXED_WIDTH - 1);
|
|
min = min >> (2 * FIXED_WIDTH - 1 - I_F_BITS);
|
|
#else
|
|
min = 0;
|
|
#endif
|
|
if (*a > max)
|
|
*a = max;
|
|
else if (*a < min)
|
|
*a = min;
|
|
}
|
|
#endif /* FIXED_SATURATE1 */
|
|
|
|
#if defined(FIXED_SATURATE2) && defined(L_saturate2)
|
|
void
|
|
FIXED_SATURATE2 (INT_C_TYPE *high, INT_C_TYPE *low)
|
|
{
|
|
INT_C_TYPE r_max, s_max, r_min, s_min;
|
|
r_max = 0;
|
|
#if (MODE_UNSIGNED == 0) || HAVE_PADDING_BITS
|
|
s_max = (INT_C_TYPE)1 << I_F_BITS;
|
|
s_max = s_max - 1;
|
|
#else
|
|
s_max = -1;
|
|
#endif
|
|
#if MODE_UNSIGNED == 0
|
|
r_min = -1;
|
|
s_min = (INT_C_TYPE)1 << (FIXED_WIDTH - 1);
|
|
s_min = s_min >> (FIXED_WIDTH - 1 - I_F_BITS);
|
|
#else
|
|
r_min = 0;
|
|
s_min = 0;
|
|
#endif
|
|
|
|
if (*high > r_max
|
|
|| (*high == r_max && (UINT_C_TYPE)(*low) > (UINT_C_TYPE)s_max))
|
|
{
|
|
*high = r_max;
|
|
*low = s_max;
|
|
}
|
|
else if (*high < r_min ||
|
|
(*high == r_min && (UINT_C_TYPE)(*low) < (UINT_C_TYPE)s_min))
|
|
{
|
|
*high = r_min;
|
|
*low = s_min;
|
|
}
|
|
}
|
|
#endif /* FIXED_SATURATE2 */
|
|
|
|
#if defined(FIXED_MULHELPER) && defined(L_mulhelper)
|
|
FIXED_C_TYPE
|
|
FIXED_MULHELPER (FIXED_C_TYPE a, FIXED_C_TYPE b, word_type satp)
|
|
{
|
|
FIXED_C_TYPE c;
|
|
INT_C_TYPE x, y;
|
|
|
|
#if defined (DINT_C_TYPE)
|
|
INT_C_TYPE z;
|
|
DINT_C_TYPE dx, dy, dz;
|
|
memcpy (&x, &a, FIXED_SIZE);
|
|
memcpy (&y, &b, FIXED_SIZE);
|
|
dx = (DINT_C_TYPE) x;
|
|
dy = (DINT_C_TYPE) y;
|
|
dz = dx * dy;
|
|
/* Round the result by adding (1 << (FBITS -1)). */
|
|
dz += ((DINT_C_TYPE) 1 << (FBITS - 1));
|
|
dz = dz >> FBITS;
|
|
if (satp)
|
|
FIXED_SATURATE1 (&dz);
|
|
|
|
z = (INT_C_TYPE) dz;
|
|
#if HAVE_PADDING_BITS
|
|
z = z << PADDING_BITS;
|
|
z = z >> PADDING_BITS;
|
|
#endif
|
|
memcpy (&c, &z, FIXED_SIZE);
|
|
return c;
|
|
|
|
#else /* No DINT_C_TYPE */
|
|
/* The result of multiplication expands to two INT_C_TYPE. */
|
|
INTunion aa, bb;
|
|
INTunion a_high, a_low, b_high, b_low;
|
|
INTunion high_high, high_low, low_high, low_low;
|
|
INTunion r, s, temp1, temp2;
|
|
INT_C_TYPE carry = 0;
|
|
INT_C_TYPE z;
|
|
|
|
memcpy (&x, &a, FIXED_SIZE);
|
|
memcpy (&y, &b, FIXED_SIZE);
|
|
|
|
/* Decompose a and b. */
|
|
aa.ll = x;
|
|
bb.ll = y;
|
|
|
|
a_high.s.low = aa.s.high;
|
|
a_high.s.high = 0;
|
|
a_low.s.low = aa.s.low;
|
|
a_low.s.high = 0;
|
|
b_high.s.low = bb.s.high;
|
|
b_high.s.high = 0;
|
|
b_low.s.low = bb.s.low;
|
|
b_low.s.high = 0;
|
|
|
|
/* Perform four multiplications. */
|
|
low_low.ll = a_low.ll * b_low.ll;
|
|
low_high.ll = a_low.ll * b_high.ll;
|
|
high_low.ll = a_high.ll * b_low.ll;
|
|
high_high.ll = a_high.ll * b_high.ll;
|
|
|
|
/* Accumulate four results to {r, s}. */
|
|
temp1.s.high = high_low.s.low;
|
|
temp1.s.low = 0;
|
|
s.ll = low_low.ll + temp1.ll;
|
|
if ((UINT_C_TYPE) s.ll < (UINT_C_TYPE) low_low.ll
|
|
|| (UINT_C_TYPE) s.ll < (UINT_C_TYPE) temp1.ll)
|
|
carry ++; /* Carry. */
|
|
temp1.ll = s.ll;
|
|
temp2.s.high = low_high.s.low;
|
|
temp2.s.low = 0;
|
|
s.ll = temp1.ll + temp2.ll;
|
|
if ((UINT_C_TYPE) s.ll < (UINT_C_TYPE) temp1.ll
|
|
|| (UINT_C_TYPE) s.ll < (UINT_C_TYPE) temp2.ll)
|
|
carry ++; /* Carry. */
|
|
|
|
temp1.s.low = high_low.s.high;
|
|
temp1.s.high = 0;
|
|
r.ll = high_high.ll + temp1.ll;
|
|
temp1.s.low = low_high.s.high;
|
|
temp1.s.high = 0;
|
|
r.ll = r.ll + temp1.ll + carry;
|
|
|
|
#if MODE_UNSIGNED == 0
|
|
/* For signed types, we need to add neg(y) to r, if x < 0. */
|
|
if (x < 0)
|
|
r.ll = r.ll - y;
|
|
/* We need to add neg(x) to r, if y < 0. */
|
|
if (y < 0)
|
|
r.ll = r.ll - x;
|
|
#endif
|
|
|
|
/* Round the result by adding (1 << (FBITS -1)). */
|
|
temp1.ll = s.ll;
|
|
s.ll += ((INT_C_TYPE) 1 << (FBITS -1));
|
|
if ((UINT_C_TYPE) s.ll < (UINT_C_TYPE) temp1.ll
|
|
|| (UINT_C_TYPE) s.ll < (UINT_C_TYPE) ((INT_C_TYPE) 1 << (FBITS -1)))
|
|
r.ll += 1;
|
|
|
|
/* Shift right the result by FBITS. */
|
|
#if FBITS == FIXED_WIDTH
|
|
/* This happens only for unsigned types without any padding bits.
|
|
So, it is safe to set r.ll to 0 as it is logically shifted right. */
|
|
s.ll = r.ll;
|
|
r.ll = 0;
|
|
#else
|
|
s.ll = ((UINT_C_TYPE)s.ll) >> FBITS;
|
|
temp1.ll = r.ll << (FIXED_WIDTH - FBITS);
|
|
s.ll = s.ll | temp1.ll;
|
|
r.ll = r.ll >> FBITS;
|
|
#endif
|
|
|
|
if (satp)
|
|
FIXED_SATURATE2 (&r.ll, &s.ll);
|
|
|
|
z = (INT_C_TYPE) s.ll;
|
|
#if HAVE_PADDING_BITS
|
|
z = z << PADDING_BITS;
|
|
z = z >> PADDING_BITS;
|
|
#endif
|
|
memcpy (&c, &z, FIXED_SIZE);
|
|
return c;
|
|
#endif
|
|
}
|
|
#endif /* FIXED_MULHELPER */
|
|
|
|
#if defined(FIXED_MUL) && defined(L_mul)
|
|
FIXED_C_TYPE
|
|
FIXED_MUL (FIXED_C_TYPE a, FIXED_C_TYPE b)
|
|
{
|
|
return FIXED_MULHELPER (a, b, 0);
|
|
}
|
|
#endif /* FIXED_MUL */
|
|
|
|
#if defined(FIXED_SSMUL) && defined(L_ssmul)
|
|
FIXED_C_TYPE
|
|
FIXED_SSMUL (FIXED_C_TYPE a, FIXED_C_TYPE b)
|
|
{
|
|
return FIXED_MULHELPER (a, b, 1);
|
|
}
|
|
#endif /* FIXED_SSMUL */
|
|
|
|
#if defined(FIXED_USMUL) && defined(L_usmul)
|
|
FIXED_C_TYPE
|
|
FIXED_USMUL (FIXED_C_TYPE a, FIXED_C_TYPE b)
|
|
{
|
|
return FIXED_MULHELPER (a, b, 1);
|
|
}
|
|
#endif /* FIXED_USMUL */
|
|
|
|
#if defined(FIXED_DIVHELPER) && defined(L_divhelper)
|
|
FIXED_C_TYPE
|
|
FIXED_DIVHELPER (FIXED_C_TYPE a, FIXED_C_TYPE b, word_type satp)
|
|
{
|
|
FIXED_C_TYPE c;
|
|
INT_C_TYPE x, y;
|
|
INT_C_TYPE z;
|
|
|
|
#if defined (DINT_C_TYPE)
|
|
DINT_C_TYPE dx, dy, dz;
|
|
memcpy (&x, &a, FIXED_SIZE);
|
|
memcpy (&y, &b, FIXED_SIZE);
|
|
dx = (DINT_C_TYPE) x;
|
|
dy = (DINT_C_TYPE) y;
|
|
dx = dx << FBITS;
|
|
dz = dx / dy;
|
|
if (satp)
|
|
FIXED_SATURATE1 (&dz);
|
|
z = (INT_C_TYPE) dz;
|
|
#if HAVE_PADDING_BITS
|
|
z = z << PADDING_BITS;
|
|
z = z >> PADDING_BITS;
|
|
#endif
|
|
memcpy (&c, &z, FIXED_SIZE);
|
|
return c;
|
|
|
|
#else /* No DINT_C_TYPE */
|
|
INT_C_TYPE pos_a, pos_b, r, s;
|
|
INT_C_TYPE quo_r, quo_s, mod, temp;
|
|
word_type i;
|
|
#if MODE_UNSIGNED == 0
|
|
word_type num_of_neg = 0;
|
|
#endif
|
|
|
|
memcpy (&x, &a, FIXED_SIZE);
|
|
memcpy (&y, &b, FIXED_SIZE);
|
|
pos_a = x;
|
|
pos_b = y;
|
|
|
|
#if MODE_UNSIGNED == 0
|
|
/* If a < 0, negate a. */
|
|
if (pos_a < 0)
|
|
{
|
|
pos_a = -pos_a;
|
|
num_of_neg ++;
|
|
}
|
|
/* If b < 0, negate b. */
|
|
if (pos_b < 0)
|
|
{
|
|
pos_b = -pos_b;
|
|
num_of_neg ++;
|
|
}
|
|
#endif
|
|
|
|
/* Left shift pos_a to {r, s} by FBITS. */
|
|
#if FBITS == FIXED_WIDTH
|
|
/* This happens only for unsigned types without any padding bits. */
|
|
r = pos_a;
|
|
s = 0;
|
|
#else
|
|
s = pos_a << FBITS;
|
|
r = pos_a >> (FIXED_WIDTH - FBITS);
|
|
#endif
|
|
|
|
/* Unsigned divide r by pos_b to quo_r. The remainder is in mod. */
|
|
quo_r = (UINT_C_TYPE)r / (UINT_C_TYPE)pos_b;
|
|
mod = (UINT_C_TYPE)r % (UINT_C_TYPE)pos_b;
|
|
quo_s = 0;
|
|
|
|
for (i = 0; i < FIXED_WIDTH; i++)
|
|
{
|
|
/* Record the leftmost bit of mod. */
|
|
word_type leftmost_mode = (mod >> (FIXED_WIDTH - 1)) & 1;
|
|
/* Shift left mod by 1 bit. */
|
|
mod = mod << 1;
|
|
/* Test the leftmost bit of s to add to mod. */
|
|
if ((s >> (FIXED_WIDTH - 1)) & 1)
|
|
mod ++;
|
|
/* Shift left quo_s by 1 bit. */
|
|
quo_s = quo_s << 1;
|
|
/* Try to calculate (mod - pos_b). */
|
|
temp = mod - pos_b;
|
|
if (leftmost_mode || (UINT_C_TYPE)mod >= (UINT_C_TYPE)pos_b)
|
|
{
|
|
quo_s ++;
|
|
mod = temp;
|
|
}
|
|
/* Shift left s by 1 bit. */
|
|
s = s << 1;
|
|
}
|
|
|
|
#if MODE_UNSIGNED == 0
|
|
if (num_of_neg == 1)
|
|
{
|
|
quo_s = -quo_s;
|
|
if (quo_s == 0)
|
|
quo_r = -quo_r;
|
|
else
|
|
quo_r = ~quo_r;
|
|
}
|
|
#endif
|
|
if (satp)
|
|
FIXED_SATURATE2 (&quo_r, &quo_s);
|
|
z = quo_s;
|
|
#if HAVE_PADDING_BITS
|
|
z = z << PADDING_BITS;
|
|
z = z >> PADDING_BITS;
|
|
#endif
|
|
memcpy (&c, &z, FIXED_SIZE);
|
|
return c;
|
|
#endif
|
|
}
|
|
#endif /* FIXED_DIVHELPER */
|
|
|
|
#if defined(FIXED_DIV) && defined(L_div)
|
|
FIXED_C_TYPE
|
|
FIXED_DIV (FIXED_C_TYPE a, FIXED_C_TYPE b)
|
|
{
|
|
return FIXED_DIVHELPER (a, b, 0);
|
|
}
|
|
#endif /* FIXED_DIV */
|
|
|
|
|
|
#if defined(FIXED_UDIV) && defined(L_udiv)
|
|
FIXED_C_TYPE
|
|
FIXED_UDIV (FIXED_C_TYPE a, FIXED_C_TYPE b)
|
|
{
|
|
return FIXED_DIVHELPER (a, b, 0);
|
|
}
|
|
#endif /* FIXED_UDIV */
|
|
|
|
#if defined(FIXED_SSDIV) && defined(L_ssdiv)
|
|
FIXED_C_TYPE
|
|
FIXED_SSDIV (FIXED_C_TYPE a, FIXED_C_TYPE b)
|
|
{
|
|
return FIXED_DIVHELPER (a, b, 1);
|
|
}
|
|
#endif /* FIXED_SSDIV */
|
|
|
|
#if defined(FIXED_USDIV) && defined(L_usdiv)
|
|
FIXED_C_TYPE
|
|
FIXED_USDIV (FIXED_C_TYPE a, FIXED_C_TYPE b)
|
|
{
|
|
return FIXED_DIVHELPER (a, b, 1);
|
|
}
|
|
#endif /* FIXED_USDIV */
|
|
|
|
#if defined(FIXED_NEG) && defined(L_neg)
|
|
FIXED_C_TYPE
|
|
FIXED_NEG (FIXED_C_TYPE a)
|
|
{
|
|
FIXED_C_TYPE c;
|
|
INT_C_TYPE x, z;
|
|
memcpy (&x, &a, FIXED_SIZE);
|
|
z = -x;
|
|
#if HAVE_PADDING_BITS
|
|
z = z << PADDING_BITS;
|
|
z = z >> PADDING_BITS;
|
|
#endif
|
|
memcpy (&c, &z, FIXED_SIZE);
|
|
return c;
|
|
}
|
|
#endif /* FIXED_NEG */
|
|
|
|
#if defined(FIXED_SSNEG) && defined(L_ssneg)
|
|
FIXED_C_TYPE
|
|
FIXED_SSNEG (FIXED_C_TYPE a)
|
|
{
|
|
FIXED_C_TYPE c;
|
|
INT_C_TYPE x, y, z;
|
|
memcpy (&y, &a, FIXED_SIZE);
|
|
x = 0;
|
|
z = x - (UINT_C_TYPE) y;
|
|
if (((x ^ y) >> I_F_BITS) & 1)
|
|
{
|
|
if (((z ^ x) >> I_F_BITS) & 1)
|
|
z = (((UINT_C_TYPE) 1) << I_F_BITS) - 1;
|
|
}
|
|
#if HAVE_PADDING_BITS
|
|
z = z << PADDING_BITS;
|
|
z = z >> PADDING_BITS;
|
|
#endif
|
|
memcpy (&c, &z, FIXED_SIZE);
|
|
return c;
|
|
}
|
|
#endif /* FIXED_SSNEG */
|
|
|
|
#if defined(FIXED_USNEG) && defined(L_usneg)
|
|
FIXED_C_TYPE
|
|
FIXED_USNEG (FIXED_C_TYPE a __attribute__ ((__unused__)))
|
|
{
|
|
FIXED_C_TYPE c;
|
|
INT_C_TYPE z;
|
|
z = 0;
|
|
memcpy (&c, &z, FIXED_SIZE);
|
|
return c;
|
|
}
|
|
#endif /* FIXED_USNEG */
|
|
|
|
#if defined(FIXED_ASHLHELPER) && defined(L_ashlhelper)
|
|
FIXED_C_TYPE
|
|
FIXED_ASHLHELPER (FIXED_C_TYPE a, word_type b, word_type satp)
|
|
{
|
|
FIXED_C_TYPE c;
|
|
INT_C_TYPE x, z;
|
|
|
|
#if defined (DINT_C_TYPE)
|
|
DINT_C_TYPE dx, dz;
|
|
memcpy (&x, &a, FIXED_SIZE);
|
|
dx = (DINT_C_TYPE) x;
|
|
if (b >= FIXED_WIDTH)
|
|
dz = dx << FIXED_WIDTH;
|
|
else
|
|
dz = dx << b;
|
|
if (satp)
|
|
FIXED_SATURATE1 (&dz);
|
|
z = (INT_C_TYPE) dz;
|
|
#if HAVE_PADDING_BITS
|
|
z = z << PADDING_BITS;
|
|
z = z >> PADDING_BITS;
|
|
#endif
|
|
memcpy (&c, &z, FIXED_SIZE);
|
|
return c;
|
|
|
|
#else /* No DINT_C_TYPE */
|
|
INT_C_TYPE r, s;
|
|
memcpy (&x, &a, FIXED_SIZE);
|
|
/* We need to shift left x by b bits to {r, s}. */
|
|
if (b >= FIXED_WIDTH)
|
|
{
|
|
r = b;
|
|
s = 0;
|
|
}
|
|
else
|
|
{
|
|
s = x << b;
|
|
r = x >> (FIXED_WIDTH - b);
|
|
}
|
|
if (satp)
|
|
FIXED_SATURATE2 (&r, &s);
|
|
z = s;
|
|
#if HAVE_PADDING_BITS
|
|
z = z << PADDING_BITS;
|
|
z = z >> PADDING_BITS;
|
|
#endif
|
|
memcpy (&c, &z, FIXED_SIZE);
|
|
return c;
|
|
#endif
|
|
}
|
|
#endif /* FIXED_ASHLHELPER */
|
|
|
|
#if defined(FIXED_ASHL) && defined(L_ashl)
|
|
FIXED_C_TYPE
|
|
FIXED_ASHL (FIXED_C_TYPE a, word_type b)
|
|
{
|
|
return FIXED_ASHLHELPER (a, b, 0);
|
|
}
|
|
#endif /* FIXED_ASHL */
|
|
|
|
#if defined(FIXED_ASHR) && defined(L_ashr)
|
|
FIXED_C_TYPE
|
|
FIXED_ASHR (FIXED_C_TYPE a, word_type b)
|
|
{
|
|
FIXED_C_TYPE c;
|
|
INT_C_TYPE x, z;
|
|
memcpy (&x, &a, FIXED_SIZE);
|
|
z = x >> b;
|
|
#if HAVE_PADDING_BITS
|
|
z = z << PADDING_BITS;
|
|
z = z >> PADDING_BITS;
|
|
#endif
|
|
memcpy (&c, &z, FIXED_SIZE);
|
|
return c;
|
|
}
|
|
#endif /* FIXED_ASHR */
|
|
|
|
#if defined(FIXED_LSHR) && defined(L_lshr)
|
|
FIXED_C_TYPE
|
|
FIXED_LSHR (FIXED_C_TYPE a, word_type b)
|
|
{
|
|
FIXED_C_TYPE c;
|
|
INT_C_TYPE x, z;
|
|
memcpy (&x, &a, FIXED_SIZE);
|
|
z = x >> b;
|
|
#if HAVE_PADDING_BITS
|
|
z = z << PADDING_BITS;
|
|
z = z >> PADDING_BITS;
|
|
#endif
|
|
memcpy (&c, &z, FIXED_SIZE);
|
|
return c;
|
|
}
|
|
#endif /* FIXED_LSHR */
|
|
|
|
#if defined(FIXED_SSASHL) && defined(L_ssashl)
|
|
FIXED_C_TYPE
|
|
FIXED_SSASHL (FIXED_C_TYPE a, word_type b)
|
|
{
|
|
return FIXED_ASHLHELPER (a, b, 1);
|
|
}
|
|
#endif /* FIXED_SSASHL */
|
|
|
|
#if defined(FIXED_USASHL) && defined(L_usashl)
|
|
FIXED_C_TYPE
|
|
FIXED_USASHL (FIXED_C_TYPE a, word_type b)
|
|
{
|
|
return FIXED_ASHLHELPER (a, b, 1);
|
|
}
|
|
#endif /* FIXED_USASHL */
|
|
|
|
#if defined(FIXED_CMP) && defined(L_cmp)
|
|
word_type
|
|
FIXED_CMP (FIXED_C_TYPE a, FIXED_C_TYPE b)
|
|
{
|
|
INT_C_TYPE x, y;
|
|
memcpy (&x, &a, FIXED_SIZE);
|
|
memcpy (&y, &b, FIXED_SIZE);
|
|
|
|
if (x < y)
|
|
return 0;
|
|
else if (x > y)
|
|
return 2;
|
|
|
|
return 1;
|
|
}
|
|
#endif /* FIXED_CMP */
|
|
|
|
/* Fixed -> Fixed. */
|
|
#if defined(FRACT) && defined(L_fract) && FROM_TYPE == 4 && TO_TYPE == 4
|
|
TO_FIXED_C_TYPE
|
|
FRACT (FROM_FIXED_C_TYPE a)
|
|
{
|
|
TO_FIXED_C_TYPE c;
|
|
FROM_INT_C_TYPE x;
|
|
TO_INT_C_TYPE z;
|
|
int shift_amount;
|
|
memcpy (&x, &a, FROM_FIXED_SIZE);
|
|
#if TO_FBITS > FROM_FBITS /* Need left shift. */
|
|
shift_amount = TO_FBITS - FROM_FBITS;
|
|
z = (TO_INT_C_TYPE) x;
|
|
z = z << shift_amount;
|
|
#else /* TO_FBITS <= FROM_FBITS. Need right Shift. */
|
|
shift_amount = FROM_FBITS - TO_FBITS;
|
|
x = x >> shift_amount;
|
|
z = (TO_INT_C_TYPE) x;
|
|
#endif /* TO_FBITS > FROM_FBITS */
|
|
|
|
#if TO_HAVE_PADDING_BITS
|
|
z = z << TO_PADDING_BITS;
|
|
z = z >> TO_PADDING_BITS;
|
|
#endif
|
|
memcpy (&c, &z, TO_FIXED_SIZE);
|
|
return c;
|
|
}
|
|
#endif /* FRACT && FROM_TYPE == 4 && TO_TYPE == 4 */
|
|
|
|
/* Fixed -> Fixed with saturation. */
|
|
#if defined(SATFRACT) && defined(L_satfract) && FROM_TYPE == 4 && TO_TYPE == 4
|
|
TO_FIXED_C_TYPE
|
|
SATFRACT (FROM_FIXED_C_TYPE a)
|
|
{
|
|
TO_FIXED_C_TYPE c;
|
|
TO_INT_C_TYPE z;
|
|
FROM_INT_C_TYPE x;
|
|
#if FROM_MODE_UNSIGNED == 0
|
|
BIG_SINT_C_TYPE high, low;
|
|
BIG_SINT_C_TYPE max_high, max_low;
|
|
#if TO_MODE_UNSIGNED == 0
|
|
BIG_SINT_C_TYPE min_high, min_low;
|
|
#endif
|
|
#else
|
|
BIG_UINT_C_TYPE high, low;
|
|
BIG_UINT_C_TYPE max_high, max_low;
|
|
#endif
|
|
#if TO_FBITS > FROM_FBITS
|
|
BIG_UINT_C_TYPE utemp;
|
|
#endif
|
|
#if TO_MODE_UNSIGNED == 0
|
|
BIG_SINT_C_TYPE stemp;
|
|
#endif
|
|
#if TO_FBITS != FROM_FBITS
|
|
int shift_amount;
|
|
#endif
|
|
memcpy (&x, &a, FROM_FIXED_SIZE);
|
|
|
|
/* Step 1. We need to store x to {high, low}. */
|
|
#if FROM_MODE_UNSIGNED == 0
|
|
low = (BIG_SINT_C_TYPE) x;
|
|
if (x < 0)
|
|
high = -1;
|
|
else
|
|
high = 0;
|
|
#else
|
|
low = (BIG_UINT_C_TYPE) x;
|
|
high = 0;
|
|
#endif
|
|
|
|
/* Step 2. We need to shift {high, low}. */
|
|
#if TO_FBITS > FROM_FBITS /* Left shift. */
|
|
shift_amount = TO_FBITS - FROM_FBITS;
|
|
utemp = (BIG_UINT_C_TYPE) low;
|
|
utemp = utemp >> (BIG_WIDTH - shift_amount);
|
|
high = ((BIG_UINT_C_TYPE)(high << shift_amount)) | utemp;
|
|
low = low << shift_amount;
|
|
#elif TO_FBITS < FROM_FBITS /* Right shift. */
|
|
shift_amount = FROM_FBITS - TO_FBITS;
|
|
low = low >> shift_amount;
|
|
#endif
|
|
|
|
/* Step 3. Compare {high, low} with max and min of TO_FIXED_C_TYPE. */
|
|
max_high = 0;
|
|
#if BIG_WIDTH > TO_FIXED_WIDTH || TO_MODE_UNSIGNED == 0 || TO_HAVE_PADDING_BITS
|
|
max_low = (BIG_UINT_C_TYPE)1 << TO_I_F_BITS;
|
|
max_low = max_low - 1;
|
|
#else
|
|
max_low = -1;
|
|
#endif
|
|
|
|
#if TO_MODE_UNSIGNED == 0
|
|
stemp = (BIG_SINT_C_TYPE)1 << (BIG_WIDTH - 1);
|
|
stemp = stemp >> (BIG_WIDTH - 1 - TO_I_F_BITS);
|
|
#if FROM_MODE_UNSIGNED == 0
|
|
min_high = -1;
|
|
min_low = stemp;
|
|
#endif
|
|
#endif
|
|
|
|
#if FROM_MODE_UNSIGNED == 0 && TO_MODE_UNSIGNED == 0
|
|
/* Signed -> Signed. */
|
|
if ((BIG_SINT_C_TYPE) high > (BIG_SINT_C_TYPE) max_high
|
|
|| ((BIG_SINT_C_TYPE) high == (BIG_SINT_C_TYPE) max_high
|
|
&& (BIG_UINT_C_TYPE) low > (BIG_UINT_C_TYPE) max_low))
|
|
low = max_low; /* Maximum. */
|
|
else if ((BIG_SINT_C_TYPE) high < (BIG_SINT_C_TYPE) min_high
|
|
|| ((BIG_SINT_C_TYPE) high == (BIG_SINT_C_TYPE) min_high
|
|
&& (BIG_UINT_C_TYPE) low < (BIG_UINT_C_TYPE) min_low))
|
|
low = min_low; /* Minimum. */
|
|
#elif FROM_MODE_UNSIGNED == 1 && TO_MODE_UNSIGNED == 1
|
|
/* Unigned -> Unsigned. */
|
|
if ((BIG_UINT_C_TYPE) high > (BIG_UINT_C_TYPE) max_high
|
|
|| ((BIG_UINT_C_TYPE) high == (BIG_UINT_C_TYPE) max_high
|
|
&& (BIG_UINT_C_TYPE) low > (BIG_UINT_C_TYPE) max_low))
|
|
low = max_low; /* Maximum. */
|
|
#elif FROM_MODE_UNSIGNED == 0 && TO_MODE_UNSIGNED == 1
|
|
/* Signed -> Unsigned. */
|
|
if (x < 0)
|
|
low = 0; /* Minimum. */
|
|
else if ((BIG_UINT_C_TYPE) high > (BIG_UINT_C_TYPE) max_high
|
|
|| ((BIG_UINT_C_TYPE) high == (BIG_UINT_C_TYPE) max_high
|
|
&& (BIG_UINT_C_TYPE) low > (BIG_UINT_C_TYPE) max_low))
|
|
low = max_low; /* Maximum. */
|
|
#elif FROM_MODE_UNSIGNED == 1 && TO_MODE_UNSIGNED == 0
|
|
/* Unsigned -> Signed. */
|
|
if ((BIG_SINT_C_TYPE) high < 0)
|
|
low = max_low; /* Maximum. */
|
|
else if ((BIG_SINT_C_TYPE) high > (BIG_SINT_C_TYPE) max_high
|
|
|| ((BIG_SINT_C_TYPE) high == (BIG_SINT_C_TYPE) max_high
|
|
&& (BIG_UINT_C_TYPE) low > (BIG_UINT_C_TYPE) max_low))
|
|
low = max_low; /* Maximum. */
|
|
#endif
|
|
|
|
/* Step 4. Store the result. */
|
|
z = (TO_INT_C_TYPE) low;
|
|
#if TO_HAVE_PADDING_BITS
|
|
z = z << TO_PADDING_BITS;
|
|
z = z >> TO_PADDING_BITS;
|
|
#endif
|
|
memcpy (&c, &z, TO_FIXED_SIZE);
|
|
return c;
|
|
}
|
|
#endif /* defined(SATFRACT) && FROM_TYPE == 4 && TO_TYPE == 4 */
|
|
|
|
/* Fixed -> Int. */
|
|
#if defined(FRACT) && defined(L_fract) && FROM_TYPE == 4 && TO_TYPE == 1
|
|
TO_INT_C_TYPE
|
|
FRACT (FROM_FIXED_C_TYPE a)
|
|
{
|
|
FROM_INT_C_TYPE x;
|
|
TO_INT_C_TYPE z;
|
|
FROM_INT_C_TYPE i = 0;
|
|
memcpy (&x, &a, FROM_FIXED_SIZE);
|
|
|
|
#if FROM_MODE_UNSIGNED == 0
|
|
if (x < 0)
|
|
{
|
|
#if FROM_FIXED_WIDTH == FROM_FBITS
|
|
if (x != 0)
|
|
i = 1;
|
|
#else
|
|
if (((FROM_INT_C_TYPE)(x << (FROM_FIXED_WIDTH - FROM_FBITS))) != 0)
|
|
i = 1;
|
|
#endif
|
|
}
|
|
#endif
|
|
|
|
#if FROM_FIXED_WIDTH == FROM_FBITS
|
|
x = 0;
|
|
#else
|
|
x = x >> FROM_FBITS;
|
|
#endif
|
|
x = x + i;
|
|
z = (TO_INT_C_TYPE) x;
|
|
return z;
|
|
}
|
|
#endif /* defined(FRACT) && FROM_TYPE == 4 && TO_TYPE == 1 */
|
|
|
|
/* Fixed -> Unsigned int. */
|
|
#if defined(FRACTUNS) && defined(L_fractuns) && FROM_TYPE == 4 && TO_TYPE == 2
|
|
TO_INT_C_TYPE
|
|
FRACTUNS (FROM_FIXED_C_TYPE a)
|
|
{
|
|
FROM_INT_C_TYPE x;
|
|
TO_INT_C_TYPE z;
|
|
FROM_INT_C_TYPE i = 0;
|
|
memcpy (&x, &a, FROM_FIXED_SIZE);
|
|
|
|
#if FROM_MODE_UNSIGNED == 0
|
|
if (x < 0)
|
|
{
|
|
#if FROM_FIXED_WIDTH == FROM_FBITS
|
|
if (x != 0)
|
|
i = 1;
|
|
#else
|
|
if (((FROM_INT_C_TYPE)(x << (FROM_FIXED_WIDTH - FROM_FBITS))) != 0)
|
|
i = 1;
|
|
#endif
|
|
}
|
|
#endif
|
|
|
|
#if FROM_FIXED_WIDTH == FROM_FBITS
|
|
x = 0;
|
|
#else
|
|
x = x >> FROM_FBITS;
|
|
#endif
|
|
x = x + i;
|
|
z = (TO_INT_C_TYPE) x;
|
|
return z;
|
|
}
|
|
#endif /* defined(FRACTUNS) && FROM_TYPE == 4 && TO_TYPE == 2 */
|
|
|
|
/* Int -> Fixed. */
|
|
#if defined(FRACT) && defined(L_fract) && FROM_TYPE == 1 && TO_TYPE == 4
|
|
TO_FIXED_C_TYPE
|
|
FRACT (FROM_INT_C_TYPE a)
|
|
{
|
|
TO_FIXED_C_TYPE c;
|
|
TO_INT_C_TYPE z;
|
|
z = (TO_INT_C_TYPE) a;
|
|
#if TO_FIXED_WIDTH == TO_FBITS
|
|
z = 0;
|
|
#else
|
|
z = z << TO_FBITS;
|
|
#endif
|
|
#if TO_HAVE_PADDING_BITS
|
|
z = z << TO_PADDING_BITS;
|
|
z = z >> TO_PADDING_BITS;
|
|
#endif
|
|
memcpy (&c, &z, TO_FIXED_SIZE);
|
|
return c;
|
|
}
|
|
#endif /* defined(FRACT) && FROM_TYPE == 1 && TO_TYPE == 4 */
|
|
|
|
/* Signed int -> Fixed with saturation. */
|
|
#if defined(SATFRACT) && defined(L_satfract) && FROM_TYPE == 1 && TO_TYPE == 4
|
|
TO_FIXED_C_TYPE
|
|
SATFRACT (FROM_INT_C_TYPE a)
|
|
{
|
|
TO_FIXED_C_TYPE c;
|
|
TO_INT_C_TYPE z;
|
|
FROM_INT_C_TYPE x = a;
|
|
BIG_SINT_C_TYPE high, low;
|
|
BIG_SINT_C_TYPE max_high, max_low;
|
|
#if TO_MODE_UNSIGNED == 0
|
|
BIG_SINT_C_TYPE min_high, min_low;
|
|
BIG_SINT_C_TYPE stemp;
|
|
#endif
|
|
#if BIG_WIDTH != TO_FBITS
|
|
BIG_UINT_C_TYPE utemp;
|
|
int shift_amount;
|
|
#endif
|
|
|
|
/* Step 1. We need to store x to {high, low}. */
|
|
low = (BIG_SINT_C_TYPE) x;
|
|
if (x < 0)
|
|
high = -1;
|
|
else
|
|
high = 0;
|
|
|
|
/* Step 2. We need to left shift {high, low}. */
|
|
#if BIG_WIDTH == TO_FBITS
|
|
high = low;
|
|
low = 0;
|
|
#else
|
|
shift_amount = TO_FBITS;
|
|
utemp = (BIG_UINT_C_TYPE) low;
|
|
utemp = utemp >> (BIG_WIDTH - shift_amount);
|
|
high = ((BIG_UINT_C_TYPE)(high << shift_amount)) | utemp;
|
|
low = low << shift_amount;
|
|
#endif
|
|
|
|
/* Step 3. Compare {high, low} with max and min of TO_FIXED_C_TYPE. */
|
|
max_high = 0;
|
|
#if BIG_WIDTH > TO_FIXED_WIDTH || TO_MODE_UNSIGNED == 0 || TO_HAVE_PADDING_BITS
|
|
max_low = (BIG_UINT_C_TYPE)1 << TO_I_F_BITS;
|
|
max_low = max_low - 1;
|
|
#else
|
|
max_low = -1;
|
|
#endif
|
|
|
|
#if TO_MODE_UNSIGNED == 0
|
|
min_high = -1;
|
|
stemp = (BIG_SINT_C_TYPE)1 << (BIG_WIDTH - 1);
|
|
stemp = stemp >> (BIG_WIDTH - 1 - TO_I_F_BITS);
|
|
min_low = stemp;
|
|
|
|
/* Signed -> Signed. */
|
|
if ((BIG_SINT_C_TYPE) high > (BIG_SINT_C_TYPE) max_high
|
|
|| ((BIG_SINT_C_TYPE) high == (BIG_SINT_C_TYPE) max_high
|
|
&& (BIG_UINT_C_TYPE) low > (BIG_UINT_C_TYPE) max_low))
|
|
low = max_low; /* Maximum. */
|
|
else if ((BIG_SINT_C_TYPE) high < (BIG_SINT_C_TYPE) min_high
|
|
|| ((BIG_SINT_C_TYPE) high == (BIG_SINT_C_TYPE) min_high
|
|
&& (BIG_UINT_C_TYPE) low < (BIG_UINT_C_TYPE) min_low))
|
|
low = min_low; /* Minimum. */
|
|
#else
|
|
/* Signed -> Unsigned. */
|
|
if (x < 0)
|
|
low = 0; /* Minimum. */
|
|
else if ((BIG_UINT_C_TYPE) high > (BIG_UINT_C_TYPE) max_high
|
|
|| ((BIG_UINT_C_TYPE) high == (BIG_UINT_C_TYPE) max_high
|
|
&& (BIG_UINT_C_TYPE) low > (BIG_UINT_C_TYPE) max_low))
|
|
low = max_low; /* Maximum. */
|
|
#endif
|
|
|
|
/* Step 4. Store the result. */
|
|
z = (TO_INT_C_TYPE) low;
|
|
#if TO_HAVE_PADDING_BITS
|
|
z = z << TO_PADDING_BITS;
|
|
z = z >> TO_PADDING_BITS;
|
|
#endif
|
|
memcpy (&c, &z, TO_FIXED_SIZE);
|
|
return c;
|
|
}
|
|
#endif /* defined(SATFRACT) && FROM_TYPE == 1 && TO_TYPE == 4 */
|
|
|
|
/* Unsigned int -> Fixed. */
|
|
#if defined(FRACTUNS) && defined(L_fractuns) &&FROM_TYPE == 2 && TO_TYPE == 4
|
|
TO_FIXED_C_TYPE
|
|
FRACTUNS (FROM_INT_C_TYPE a)
|
|
{
|
|
TO_FIXED_C_TYPE c;
|
|
TO_INT_C_TYPE z;
|
|
z = (TO_INT_C_TYPE) a;
|
|
#if TO_FIXED_WIDTH == TO_FBITS
|
|
z = 0;
|
|
#else
|
|
z = z << TO_FBITS;
|
|
#endif
|
|
#if TO_HAVE_PADDING_BITS
|
|
z = z << TO_PADDING_BITS;
|
|
z = z >> TO_PADDING_BITS;
|
|
#endif
|
|
memcpy (&c, &z, TO_FIXED_SIZE);
|
|
return c;
|
|
}
|
|
#endif /* defined(FRACTUNS) && FROM_TYPE == 2 && TO_TYPE == 4 */
|
|
|
|
/* Unsigned int -> Fixed with saturation. */
|
|
#if defined(SATFRACTUNS) && defined(L_satfractuns) && FROM_TYPE == 2 && TO_TYPE == 4
|
|
TO_FIXED_C_TYPE
|
|
SATFRACTUNS (FROM_INT_C_TYPE a)
|
|
{
|
|
TO_FIXED_C_TYPE c;
|
|
TO_INT_C_TYPE z;
|
|
FROM_INT_C_TYPE x = a;
|
|
BIG_UINT_C_TYPE high, low;
|
|
BIG_UINT_C_TYPE max_high, max_low;
|
|
#if BIG_WIDTH != TO_FBITS
|
|
BIG_UINT_C_TYPE utemp;
|
|
int shift_amount;
|
|
#endif
|
|
|
|
/* Step 1. We need to store x to {high, low}. */
|
|
low = (BIG_UINT_C_TYPE) x;
|
|
high = 0;
|
|
|
|
/* Step 2. We need to left shift {high, low}. */
|
|
#if BIG_WIDTH == TO_FBITS
|
|
high = low;
|
|
low = 0;
|
|
#else
|
|
shift_amount = TO_FBITS;
|
|
utemp = (BIG_UINT_C_TYPE) low;
|
|
utemp = utemp >> (BIG_WIDTH - shift_amount);
|
|
high = ((BIG_UINT_C_TYPE)(high << shift_amount)) | utemp;
|
|
low = low << shift_amount;
|
|
#endif
|
|
|
|
/* Step 3. Compare {high, low} with max and min of TO_FIXED_C_TYPE. */
|
|
max_high = 0;
|
|
#if BIG_WIDTH > TO_FIXED_WIDTH || TO_MODE_UNSIGNED == 0 || TO_HAVE_PADDING_BITS
|
|
max_low = (BIG_UINT_C_TYPE)1 << TO_I_F_BITS;
|
|
max_low = max_low - 1;
|
|
#else
|
|
max_low = -1;
|
|
#endif
|
|
|
|
#if TO_MODE_UNSIGNED == 1
|
|
/* Unigned -> Unsigned. */
|
|
if ((BIG_UINT_C_TYPE) high > (BIG_UINT_C_TYPE) max_high
|
|
|| ((BIG_UINT_C_TYPE) high == (BIG_UINT_C_TYPE) max_high
|
|
&& (BIG_UINT_C_TYPE) low > (BIG_UINT_C_TYPE) max_low))
|
|
low = max_low; /* Maximum. */
|
|
#else
|
|
/* Unsigned -> Signed. */
|
|
if ((BIG_SINT_C_TYPE) high < 0)
|
|
low = max_low; /* Maximum. */
|
|
else if ((BIG_SINT_C_TYPE) high > (BIG_SINT_C_TYPE) max_high
|
|
|| ((BIG_SINT_C_TYPE) high == (BIG_SINT_C_TYPE) max_high
|
|
&& (BIG_UINT_C_TYPE) low > (BIG_UINT_C_TYPE) max_low))
|
|
low = max_low; /* Maximum. */
|
|
#endif
|
|
|
|
/* Step 4. Store the result. */
|
|
z = (TO_INT_C_TYPE) low;
|
|
#if TO_HAVE_PADDING_BITS
|
|
z = z << TO_PADDING_BITS;
|
|
z = z >> TO_PADDING_BITS;
|
|
#endif
|
|
memcpy (&c, &z, TO_FIXED_SIZE);
|
|
return c;
|
|
}
|
|
#endif /* defined(SATFRACTUNS) && FROM_TYPE == 2 && TO_TYPE == 4 */
|
|
|
|
/* Fixed -> Float. */
|
|
#if defined(FRACT) && defined(L_fract) && FROM_TYPE == 4 && TO_TYPE == 3
|
|
TO_FLOAT_C_TYPE
|
|
FRACT (FROM_FIXED_C_TYPE a)
|
|
{
|
|
FROM_INT_C_TYPE x;
|
|
TO_FLOAT_C_TYPE z;
|
|
memcpy (&x, &a, FROM_FIXED_SIZE);
|
|
z = (TO_FLOAT_C_TYPE) x;
|
|
z = z / BASE;
|
|
return z;
|
|
}
|
|
#endif /* defined(FRACT) && FROM_TYPE == 4 && TO_TYPE == 3 */
|
|
|
|
/* Float -> Fixed. */
|
|
#if defined(FRACT) && defined(L_fract) && FROM_TYPE == 3 && TO_TYPE == 4
|
|
TO_FIXED_C_TYPE
|
|
FRACT (FROM_FLOAT_C_TYPE a)
|
|
{
|
|
FROM_FLOAT_C_TYPE temp;
|
|
TO_INT_C_TYPE z;
|
|
TO_FIXED_C_TYPE c;
|
|
|
|
temp = a * BASE;
|
|
z = (TO_INT_C_TYPE) temp;
|
|
#if TO_HAVE_PADDING_BITS
|
|
z = z << TO_PADDING_BITS;
|
|
z = z >> TO_PADDING_BITS;
|
|
#endif
|
|
memcpy (&c, &z, TO_FIXED_SIZE);
|
|
return c;
|
|
}
|
|
#endif /* defined(FRACT) && FROM_TYPE == 3 && TO_TYPE == 4 */
|
|
|
|
/* Float -> Fixed with saturation. */
|
|
#if defined(SATFRACT) && defined(L_satfract) && FROM_TYPE == 3 && TO_TYPE == 4
|
|
TO_FIXED_C_TYPE
|
|
SATFRACT (FROM_FLOAT_C_TYPE a)
|
|
{
|
|
FROM_FLOAT_C_TYPE temp;
|
|
TO_INT_C_TYPE z;
|
|
TO_FIXED_C_TYPE c;
|
|
|
|
if (a >= FIXED_MAX)
|
|
{
|
|
#if TO_MODE_UNSIGNED == 0 || TO_HAVE_PADDING_BITS
|
|
z = (TO_INT_C_TYPE)1 << TO_I_F_BITS;
|
|
z = z - 1;
|
|
#else
|
|
z = -1;
|
|
#endif
|
|
}
|
|
else if (a <= FIXED_MIN)
|
|
{
|
|
#if TO_MODE_UNSIGNED == 0
|
|
z = (TO_INT_C_TYPE)1 << TO_I_F_BITS;
|
|
#else
|
|
z = 0;
|
|
#endif
|
|
}
|
|
else
|
|
{
|
|
temp = a * BASE;
|
|
z = (TO_INT_C_TYPE) temp;
|
|
}
|
|
|
|
#if TO_HAVE_PADDING_BITS
|
|
z = z << TO_PADDING_BITS;
|
|
z = z >> TO_PADDING_BITS;
|
|
#endif
|
|
memcpy (&c, &z, TO_FIXED_SIZE);
|
|
return c;
|
|
}
|
|
#endif /* defined(SATFRACT) && FROM_TYPE == 3 && TO_TYPE == 4 */
|
|
|