123456789101112131415161718192021222324252627282930313233343536373839404142434445464748495051525354555657585960616263646566676869707172737475767778798081828384858687888990919293949596979899100101102103104105106107108109110111112113114115116117118119120121122123124125126127128129130131132133134135136137138139140141142143144145146147148149150151152153154155156157158159160161162163164165166167168169170171172173174175176177178179180181182183184185186187188189190191192193194195196197198199200201202203204205206207208209210211212213214215216217218219220221222223224225226227228229230231232233234235236237238239240241242243244245246247248249250251252253254255256257258259260261262263264265266267268269270271272273274275276277278279280281282283284285286287288289290291292293294295296297298299300301302303304305306307308309310311312313314315316317318319320321322323324325326327328329330331332333334335336337338339340341342343344345346347348349350351352353354355356357358359360361362363364365366367368369370371372373374375376377378379380381382383384385386387388389390391392393394395396397398399400401402403404405406407408409410411412413414415416417418419420421422423424425426427428429430431432433434435436437438439440441442443444445446447448449450451452453454455456457458459460461462463464465466467468469470471472473474475476477478479480481482483484485486487488489490491492493494495496497498499500501502503504505506507508509510511512513514515516517518519520521522523524525526527528529530531532533534535536537538539540541542543544545546547548549550551552553554555556557558559560561562563564565566567568569570571572573574575576577578579580581582583584585586587588589590591592593594595596597598599600601602603604605606607608609610611612613614615616617618619620621622623624625626627628629630631632633634635636637638639640641642643644645646647648649650651652653654655656657658659660661662663664665666667668669670671672673674675676677678679680681682683684685686687688689690691692693694695696697698699700701702703704705706707708709710711712713714715716717718719720721722723724725726727728729730731732733734735736737738739740741742743744745746747748749750751752753754755756757758759760761762763764765766767768769770771772773774775776777778779780781782783784785786787788789790791792793794795796797798799800801802803804805806807808809810811812813814815816817818819820821822823824825826827828829830831832833834835836837838839840841842843844845846847848849850851852853854855856857858859860861862863864865866867868869870871872873874875876877878879880881882883884885886887888889890891892893894895896897898899900901902903904905906907908909910911912913914915916917918919920921922923924925926927928929930931932933934935936937938939940941942943944945946947948949950951952953954955956957958959960961962963964965966967968969970971972973974975976977978979980981982983984985986987988989990991992993994995996997998999100010011002100310041005100610071008100910101011101210131014101510161017101810191020102110221023102410251026102710281029103010311032103310341035103610371038103910401041104210431044104510461047104810491050105110521053105410551056105710581059106010611062106310641065106610671068106910701071107210731074107510761077107810791080108110821083108410851086108710881089109010911092109310941095109610971098109911001101110211031104110511061107110811091110111111121113111411151116111711181119112011211122112311241125112611271128112911301131113211331134113511361137113811391140114111421143114411451146114711481149115011511152115311541155115611571158115911601161116211631164116511661167116811691170117111721173117411751176117711781179118011811182118311841185118611871188118911901191119211931194119511961197119811991200120112021203120412051206 |
- /* This is a software fixed-point library.
- Copyright (C) 2007-2015 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 */
|