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