| |
| /*============================================================================ |
| |
| This C source file is part of the SoftFloat IEEE Floating-Point Arithmetic |
| Package, Release 3d, by John R. Hauser. |
| |
| Copyright 2011, 2012, 2013, 2014 The Regents of the University of California. |
| All rights reserved. |
| |
| Redistribution and use in source and binary forms, with or without |
| modification, are permitted provided that the following conditions are met: |
| |
| 1. Redistributions of source code must retain the above copyright notice, |
| this list of conditions, and the following disclaimer. |
| |
| 2. Redistributions in binary form must reproduce the above copyright notice, |
| this list of conditions, and the following disclaimer in the documentation |
| and/or other materials provided with the distribution. |
| |
| 3. Neither the name of the University nor the names of its contributors may |
| be used to endorse or promote products derived from this software without |
| specific prior written permission. |
| |
| THIS SOFTWARE IS PROVIDED BY THE REGENTS AND CONTRIBUTORS "AS IS", AND ANY |
| EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE IMPLIED |
| WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE, ARE |
| DISCLAIMED. IN NO EVENT SHALL THE REGENTS OR CONTRIBUTORS BE LIABLE FOR ANY |
| DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL DAMAGES |
| (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS OR SERVICES; |
| LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION) HOWEVER CAUSED AND |
| ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT LIABILITY, OR TORT |
| (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY OUT OF THE USE OF THIS |
| SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF SUCH DAMAGE. |
| |
| =============================================================================*/ |
| |
| #include <stdbool.h> |
| #include <stdint.h> |
| #include "platform.h" |
| #include "internals.h" |
| #include "specialize.h" |
| #include "softfloat.h" |
| |
| void |
| softfloat_addF128M( |
| const uint32_t *aWPtr, |
| const uint32_t *bWPtr, |
| uint32_t *zWPtr, |
| bool negateB |
| ) |
| { |
| uint32_t uiA96; |
| int32_t expA; |
| uint32_t uiB96; |
| int32_t expB; |
| uint32_t uiZ96; |
| bool signZ, signB; |
| const uint32_t *tempPtr; |
| uint32_t sig96A, sig96B; |
| int32_t expDiff; |
| uint_fast8_t |
| (*addCarryMRoutinePtr)( |
| uint_fast8_t, |
| const uint32_t *, |
| const uint32_t *, |
| uint_fast8_t, |
| uint32_t * |
| ); |
| uint32_t extSigZ[5], wordSigZ; |
| uint_fast8_t carry; |
| void (*roundPackRoutinePtr)( bool, int32_t, uint32_t *, uint32_t * ); |
| |
| /*------------------------------------------------------------------------ |
| *------------------------------------------------------------------------*/ |
| uiA96 = aWPtr[indexWordHi( 4 )]; |
| expA = expF128UI96( uiA96 ); |
| uiB96 = bWPtr[indexWordHi( 4 )]; |
| expB = expF128UI96( uiB96 ); |
| /*------------------------------------------------------------------------ |
| *------------------------------------------------------------------------*/ |
| if ( (expA == 0x7FFF) || (expB == 0x7FFF) ) { |
| if ( softfloat_tryPropagateNaNF128M( aWPtr, bWPtr, zWPtr ) ) return; |
| uiZ96 = uiA96; |
| if ( expB == 0x7FFF ) { |
| uiZ96 = uiB96 ^ packToF128UI96( negateB, 0, 0 ); |
| if ( (expA == 0x7FFF) && (uiZ96 != uiA96) ) { |
| softfloat_invalidF128M( zWPtr ); |
| return; |
| } |
| } |
| zWPtr[indexWordHi( 4 )] = uiZ96; |
| zWPtr[indexWord( 4, 2 )] = 0; |
| zWPtr[indexWord( 4, 1 )] = 0; |
| zWPtr[indexWord( 4, 0 )] = 0; |
| return; |
| } |
| /*------------------------------------------------------------------------ |
| *------------------------------------------------------------------------*/ |
| signZ = signF128UI96( uiA96 ); |
| signB = signF128UI96( uiB96 ) ^ negateB; |
| negateB = (signZ != signB); |
| if ( (uint32_t) (uiA96<<1) < (uint32_t) (uiB96<<1) ) { |
| signZ = signB; |
| expA = expB; |
| expB = expF128UI96( uiA96 ); |
| tempPtr = aWPtr; |
| aWPtr = bWPtr; |
| bWPtr = tempPtr; |
| uiA96 = uiB96; |
| uiB96 = bWPtr[indexWordHi( 4 )]; |
| } |
| sig96A = fracF128UI96( uiA96 ); |
| sig96B = fracF128UI96( uiB96 ); |
| if ( expA ) { |
| --expA; |
| sig96A |= 0x00010000; |
| if ( expB ) { |
| --expB; |
| sig96B |= 0x00010000; |
| } |
| } |
| /*------------------------------------------------------------------------ |
| *------------------------------------------------------------------------*/ |
| addCarryMRoutinePtr = |
| negateB ? softfloat_addComplCarryM : softfloat_addCarryM; |
| expDiff = expA - expB; |
| if ( expDiff ) { |
| /*-------------------------------------------------------------------- |
| *--------------------------------------------------------------------*/ |
| extSigZ[indexWordHi( 5 )] = sig96B; |
| extSigZ[indexWord( 5, 3 )] = bWPtr[indexWord( 4, 2 )]; |
| extSigZ[indexWord( 5, 2 )] = bWPtr[indexWord( 4, 1 )]; |
| extSigZ[indexWord( 5, 1 )] = bWPtr[indexWord( 4, 0 )]; |
| extSigZ[indexWord( 5, 0 )] = 0; |
| softfloat_shiftRightJam160M( extSigZ, expDiff, extSigZ ); |
| sig96B = extSigZ[indexWordHi( 5 )]; |
| carry = 0; |
| if ( negateB ) { |
| sig96B = ~sig96B; |
| wordSigZ = extSigZ[indexWordLo( 5 )]; |
| extSigZ[indexWordLo( 5 )] = -wordSigZ; |
| carry = ! wordSigZ; |
| } |
| carry = |
| (*addCarryMRoutinePtr)( |
| 3, |
| &aWPtr[indexMultiwordLo( 4, 3 )], |
| &extSigZ[indexMultiword( 5, 3, 1 )], |
| carry, |
| &extSigZ[indexMultiword( 5, 3, 1 )] |
| ); |
| wordSigZ = sig96A + sig96B + carry; |
| } else { |
| /*-------------------------------------------------------------------- |
| *--------------------------------------------------------------------*/ |
| extSigZ[indexWordLo( 5 )] = 0; |
| carry = |
| (*addCarryMRoutinePtr)( |
| 3, |
| &aWPtr[indexMultiwordLo( 4, 3 )], |
| &bWPtr[indexMultiwordLo( 4, 3 )], |
| negateB, |
| &extSigZ[indexMultiword( 5, 3, 1 )] |
| ); |
| if ( negateB ) { |
| wordSigZ = sig96A + ~sig96B + carry; |
| if ( wordSigZ & 0x80000000 ) { |
| signZ = ! signZ; |
| carry = |
| softfloat_addComplCarry96M( |
| &bWPtr[indexMultiwordLo( 4, 3 )], |
| &aWPtr[indexMultiwordLo( 4, 3 )], |
| 1, |
| &extSigZ[indexMultiword( 5, 3, 1 )] |
| ); |
| wordSigZ = sig96B + ~sig96A + carry; |
| } else { |
| if ( |
| ! wordSigZ && ! extSigZ[indexWord( 5, 3 )] |
| && ! ( extSigZ[indexWord( 5, 2 )] |
| | extSigZ[indexWord( 5, 1 )] |
| | extSigZ[indexWord( 5, 0 )] |
| ) |
| ) { |
| signZ = (softfloat_roundingMode == softfloat_round_min); |
| zWPtr[indexWordHi( 4 )] = packToF128UI96( signZ, 0, 0 ); |
| zWPtr[indexWord( 4, 2 )] = 0; |
| zWPtr[indexWord( 4, 1 )] = 0; |
| zWPtr[indexWord( 4, 0 )] = 0; |
| return; |
| } |
| } |
| } else { |
| wordSigZ = sig96A + sig96B + carry; |
| } |
| } |
| extSigZ[indexWordHi( 5 )] = wordSigZ; |
| /*------------------------------------------------------------------------ |
| *------------------------------------------------------------------------*/ |
| roundPackRoutinePtr = softfloat_normRoundPackMToF128M; |
| if ( 0x00010000 <= wordSigZ ) { |
| if ( 0x00020000 <= wordSigZ ) { |
| ++expA; |
| softfloat_shortShiftRightJam160M( extSigZ, 1, extSigZ ); |
| } |
| roundPackRoutinePtr = softfloat_roundPackMToF128M; |
| } |
| (*roundPackRoutinePtr)( signZ, expA, extSigZ, zWPtr ); |
| |
| } |
| |