mirror of
				https://github.com/openhwgroup/cvw
				synced 2025-02-11 06:05:49 +00:00 
			
		
		
		
	
		
			
				
	
	
		
			351 lines
		
	
	
		
			14 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			351 lines
		
	
	
		
			14 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
| 
 | |
| /*============================================================================
 | |
| 
 | |
| This C source file is part of the SoftFloat IEEE Floating-Point Arithmetic
 | |
| Package, Release 3e, by John R. Hauser.
 | |
| 
 | |
| Copyright 2011, 2012, 2013, 2014, 2015, 2016 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"
 | |
| 
 | |
| float128_t
 | |
|  softfloat_mulAddF128(
 | |
|      uint_fast64_t uiA64,
 | |
|      uint_fast64_t uiA0,
 | |
|      uint_fast64_t uiB64,
 | |
|      uint_fast64_t uiB0,
 | |
|      uint_fast64_t uiC64,
 | |
|      uint_fast64_t uiC0,
 | |
|      uint_fast8_t op
 | |
|  )
 | |
| {
 | |
|     bool signA;
 | |
|     int_fast32_t expA;
 | |
|     struct uint128 sigA;
 | |
|     bool signB;
 | |
|     int_fast32_t expB;
 | |
|     struct uint128 sigB;
 | |
|     bool signC;
 | |
|     int_fast32_t expC;
 | |
|     struct uint128 sigC;
 | |
|     bool signZ;
 | |
|     uint_fast64_t magBits;
 | |
|     struct uint128 uiZ;
 | |
|     struct exp32_sig128 normExpSig;
 | |
|     int_fast32_t expZ;
 | |
|     uint64_t sig256Z[4];
 | |
|     struct uint128 sigZ;
 | |
|     int_fast32_t shiftDist, expDiff;
 | |
|     struct uint128 x128;
 | |
|     uint64_t sig256C[4];
 | |
|     static uint64_t zero256[4] = INIT_UINTM4( 0, 0, 0, 0 );
 | |
|     uint_fast64_t sigZExtra, sig256Z0;
 | |
|     union ui128_f128 uZ;
 | |
| 
 | |
|     /*------------------------------------------------------------------------
 | |
|     *------------------------------------------------------------------------*/
 | |
|     signA = signF128UI64( uiA64 );
 | |
|     expA  = expF128UI64( uiA64 );
 | |
|     sigA.v64 = fracF128UI64( uiA64 );
 | |
|     sigA.v0  = uiA0;
 | |
|     signB = signF128UI64( uiB64 );
 | |
|     expB  = expF128UI64( uiB64 );
 | |
|     sigB.v64 = fracF128UI64( uiB64 );
 | |
|     sigB.v0  = uiB0;
 | |
|     signC = signF128UI64( uiC64 ) ^ (op == softfloat_mulAdd_subC);
 | |
|     expC  = expF128UI64( uiC64 );
 | |
|     sigC.v64 = fracF128UI64( uiC64 );
 | |
|     sigC.v0  = uiC0;
 | |
|     signZ = signA ^ signB ^ (op == softfloat_mulAdd_subProd);
 | |
|     /*------------------------------------------------------------------------
 | |
|     *------------------------------------------------------------------------*/
 | |
|     if ( expA == 0x7FFF ) {
 | |
|         if (
 | |
|             (sigA.v64 | sigA.v0) || ((expB == 0x7FFF) && (sigB.v64 | sigB.v0))
 | |
|         ) {
 | |
|             goto propagateNaN_ABC;
 | |
|         }
 | |
|         magBits = expB | sigB.v64 | sigB.v0;
 | |
|         goto infProdArg;
 | |
|     }
 | |
|     if ( expB == 0x7FFF ) {
 | |
|         if ( sigB.v64 | sigB.v0 ) goto propagateNaN_ABC;
 | |
|         magBits = expA | sigA.v64 | sigA.v0;
 | |
|         goto infProdArg;
 | |
|     }
 | |
|     if ( expC == 0x7FFF ) {
 | |
|         if ( sigC.v64 | sigC.v0 ) {
 | |
|             uiZ.v64 = 0;
 | |
|             uiZ.v0  = 0;
 | |
|             goto propagateNaN_ZC;
 | |
|         }
 | |
|         uiZ.v64 = uiC64;
 | |
|         uiZ.v0  = uiC0;
 | |
|         goto uiZ;
 | |
|     }
 | |
|     /*------------------------------------------------------------------------
 | |
|     *------------------------------------------------------------------------*/
 | |
|     if ( ! expA ) {
 | |
|         if ( ! (sigA.v64 | sigA.v0) ) goto zeroProd;
 | |
|         normExpSig = softfloat_normSubnormalF128Sig( sigA.v64, sigA.v0 );
 | |
|         expA = normExpSig.exp;
 | |
|         sigA = normExpSig.sig;
 | |
|     }
 | |
|     if ( ! expB ) {
 | |
|         if ( ! (sigB.v64 | sigB.v0) ) goto zeroProd;
 | |
|         normExpSig = softfloat_normSubnormalF128Sig( sigB.v64, sigB.v0 );
 | |
|         expB = normExpSig.exp;
 | |
|         sigB = normExpSig.sig;
 | |
|     }
 | |
|     /*------------------------------------------------------------------------
 | |
|     *------------------------------------------------------------------------*/
 | |
|     expZ = expA + expB - 0x3FFE;
 | |
|     sigA.v64 |= UINT64_C( 0x0001000000000000 );
 | |
|     sigB.v64 |= UINT64_C( 0x0001000000000000 );
 | |
|     sigA = softfloat_shortShiftLeft128( sigA.v64, sigA.v0, 8 );
 | |
|     sigB = softfloat_shortShiftLeft128( sigB.v64, sigB.v0, 15 );
 | |
|     softfloat_mul128To256M( sigA.v64, sigA.v0, sigB.v64, sigB.v0, sig256Z );
 | |
|     sigZ.v64 = sig256Z[indexWord( 4, 3 )];
 | |
|     sigZ.v0  = sig256Z[indexWord( 4, 2 )];
 | |
|     shiftDist = 0;
 | |
|     if ( ! (sigZ.v64 & UINT64_C( 0x0100000000000000 )) ) {
 | |
|         --expZ;
 | |
|         shiftDist = -1;
 | |
|     }
 | |
|     if ( ! expC ) {
 | |
|         if ( ! (sigC.v64 | sigC.v0) ) {
 | |
|             shiftDist += 8;
 | |
|             goto sigZ;
 | |
|         }
 | |
|         normExpSig = softfloat_normSubnormalF128Sig( sigC.v64, sigC.v0 );
 | |
|         expC = normExpSig.exp;
 | |
|         sigC = normExpSig.sig;
 | |
|     }
 | |
|     sigC.v64 |= UINT64_C( 0x0001000000000000 );
 | |
|     sigC = softfloat_shortShiftLeft128( sigC.v64, sigC.v0, 8 );
 | |
|     /*------------------------------------------------------------------------
 | |
|     *------------------------------------------------------------------------*/
 | |
|     expDiff = expZ - expC;
 | |
|     if ( expDiff < 0 ) {
 | |
|         expZ = expC;
 | |
|         if ( (signZ == signC) || (expDiff < -1) ) {
 | |
|             shiftDist -= expDiff;
 | |
|             if ( shiftDist ) {
 | |
|                 sigZ =
 | |
|                     softfloat_shiftRightJam128( sigZ.v64, sigZ.v0, shiftDist );
 | |
|             }
 | |
|         } else {
 | |
|             if ( ! shiftDist ) {
 | |
|                 x128 =
 | |
|                     softfloat_shortShiftRight128(
 | |
|                         sig256Z[indexWord( 4, 1 )], sig256Z[indexWord( 4, 0 )],
 | |
|                         1
 | |
|                     );
 | |
|                 sig256Z[indexWord( 4, 1 )] = (sigZ.v0<<63) | x128.v64;
 | |
|                 sig256Z[indexWord( 4, 0 )] = x128.v0;
 | |
|                 sigZ = softfloat_shortShiftRight128( sigZ.v64, sigZ.v0, 1 );
 | |
|                 sig256Z[indexWord( 4, 3 )] = sigZ.v64;
 | |
|                 sig256Z[indexWord( 4, 2 )] = sigZ.v0;
 | |
|             }
 | |
|         }
 | |
|     } else {
 | |
|         if ( shiftDist ) softfloat_add256M( sig256Z, sig256Z, sig256Z );
 | |
|         if ( ! expDiff ) {
 | |
|             sigZ.v64 = sig256Z[indexWord( 4, 3 )];
 | |
|             sigZ.v0  = sig256Z[indexWord( 4, 2 )];
 | |
|         } else {
 | |
|             sig256C[indexWord( 4, 3 )] = sigC.v64;
 | |
|             sig256C[indexWord( 4, 2 )] = sigC.v0;
 | |
|             sig256C[indexWord( 4, 1 )] = 0;
 | |
|             sig256C[indexWord( 4, 0 )] = 0;
 | |
|             softfloat_shiftRightJam256M( sig256C, expDiff, sig256C );
 | |
|         }
 | |
|     }
 | |
|     /*------------------------------------------------------------------------
 | |
|     *------------------------------------------------------------------------*/
 | |
|     shiftDist = 8;
 | |
|     if ( signZ == signC ) {
 | |
|         /*--------------------------------------------------------------------
 | |
|         *--------------------------------------------------------------------*/
 | |
|         if ( expDiff <= 0 ) {
 | |
|             sigZ = softfloat_add128( sigC.v64, sigC.v0, sigZ.v64, sigZ.v0 );
 | |
|         } else {
 | |
|             softfloat_add256M( sig256Z, sig256C, sig256Z );
 | |
|             sigZ.v64 = sig256Z[indexWord( 4, 3 )];
 | |
|             sigZ.v0  = sig256Z[indexWord( 4, 2 )];
 | |
|         }
 | |
|         if ( sigZ.v64 & UINT64_C( 0x0200000000000000 ) ) {
 | |
|             ++expZ;
 | |
|             shiftDist = 9;
 | |
|         }
 | |
|     } else {
 | |
|         /*--------------------------------------------------------------------
 | |
|         *--------------------------------------------------------------------*/
 | |
|         if ( expDiff < 0 ) {
 | |
|             signZ = signC;
 | |
|             if ( expDiff < -1 ) {
 | |
|                 sigZ =
 | |
|                     softfloat_sub128( sigC.v64, sigC.v0, sigZ.v64, sigZ.v0 );
 | |
|                 sigZExtra =
 | |
|                     sig256Z[indexWord( 4, 1 )] | sig256Z[indexWord( 4, 0 )];
 | |
|                 if ( sigZExtra ) {
 | |
|                     sigZ = softfloat_sub128( sigZ.v64, sigZ.v0, 0, 1 );
 | |
|                 }
 | |
|                 if ( ! (sigZ.v64 & UINT64_C( 0x0100000000000000 )) ) {
 | |
|                     --expZ;
 | |
|                     shiftDist = 7;
 | |
|                 }
 | |
|                 goto shiftRightRoundPack;
 | |
|             } else {
 | |
|                 sig256C[indexWord( 4, 3 )] = sigC.v64;
 | |
|                 sig256C[indexWord( 4, 2 )] = sigC.v0;
 | |
|                 sig256C[indexWord( 4, 1 )] = 0;
 | |
|                 sig256C[indexWord( 4, 0 )] = 0;
 | |
|                 softfloat_sub256M( sig256C, sig256Z, sig256Z );
 | |
|             }
 | |
|         } else if ( ! expDiff ) {
 | |
|             sigZ = softfloat_sub128( sigZ.v64, sigZ.v0, sigC.v64, sigC.v0 );
 | |
|             if (
 | |
|                 ! (sigZ.v64 | sigZ.v0) && ! sig256Z[indexWord( 4, 1 )]
 | |
|                     && ! sig256Z[indexWord( 4, 0 )]
 | |
|             ) {
 | |
|                 goto completeCancellation;
 | |
|             }
 | |
|             sig256Z[indexWord( 4, 3 )] = sigZ.v64;
 | |
|             sig256Z[indexWord( 4, 2 )] = sigZ.v0;
 | |
|             if ( sigZ.v64 & UINT64_C( 0x8000000000000000 ) ) {
 | |
|                 signZ = ! signZ;
 | |
|                 softfloat_sub256M( zero256, sig256Z, sig256Z );
 | |
|             }
 | |
|         } else {
 | |
|             softfloat_sub256M( sig256Z, sig256C, sig256Z );
 | |
|             if ( 1 < expDiff ) {
 | |
|                 sigZ.v64 = sig256Z[indexWord( 4, 3 )];
 | |
|                 sigZ.v0  = sig256Z[indexWord( 4, 2 )];
 | |
|                 if ( ! (sigZ.v64 & UINT64_C( 0x0100000000000000 )) ) {
 | |
|                     --expZ;
 | |
|                     shiftDist = 7;
 | |
|                 }
 | |
|                 goto sigZ;
 | |
|             }
 | |
|         }
 | |
|         /*--------------------------------------------------------------------
 | |
|         *--------------------------------------------------------------------*/
 | |
|         sigZ.v64  = sig256Z[indexWord( 4, 3 )];
 | |
|         sigZ.v0   = sig256Z[indexWord( 4, 2 )];
 | |
|         sigZExtra = sig256Z[indexWord( 4, 1 )];
 | |
|         sig256Z0  = sig256Z[indexWord( 4, 0 )];
 | |
|         if ( sigZ.v64 ) {
 | |
|             if ( sig256Z0 ) sigZExtra |= 1;
 | |
|         } else {
 | |
|             expZ -= 64;
 | |
|             sigZ.v64  = sigZ.v0;
 | |
|             sigZ.v0   = sigZExtra;
 | |
|             sigZExtra = sig256Z0;
 | |
|             if ( ! sigZ.v64 ) {
 | |
|                 expZ -= 64;
 | |
|                 sigZ.v64  = sigZ.v0;
 | |
|                 sigZ.v0   = sigZExtra;
 | |
|                 sigZExtra = 0;
 | |
|                 if ( ! sigZ.v64 ) {
 | |
|                     expZ -= 64;
 | |
|                     sigZ.v64 = sigZ.v0;
 | |
|                     sigZ.v0  = 0;
 | |
|                 }
 | |
|             }
 | |
|         }
 | |
|         shiftDist = softfloat_countLeadingZeros64( sigZ.v64 );
 | |
|         expZ += 7 - shiftDist;
 | |
|         shiftDist = 15 - shiftDist;
 | |
|         if ( 0 < shiftDist ) goto shiftRightRoundPack;
 | |
|         if ( shiftDist ) {
 | |
|             shiftDist = -shiftDist;
 | |
|             sigZ = softfloat_shortShiftLeft128( sigZ.v64, sigZ.v0, shiftDist );
 | |
|             x128 = softfloat_shortShiftLeft128( 0, sigZExtra, shiftDist );
 | |
|             sigZ.v0 |= x128.v64;
 | |
|             sigZExtra = x128.v0;
 | |
|         }
 | |
|         goto roundPack;
 | |
|     }
 | |
|  sigZ:
 | |
|     sigZExtra = sig256Z[indexWord( 4, 1 )] | sig256Z[indexWord( 4, 0 )];
 | |
|  shiftRightRoundPack:
 | |
|     sigZExtra = (uint64_t) (sigZ.v0<<(64 - shiftDist)) | (sigZExtra != 0);
 | |
|     sigZ = softfloat_shortShiftRight128( sigZ.v64, sigZ.v0, shiftDist );
 | |
|  roundPack:
 | |
|     return
 | |
|         softfloat_roundPackToF128(
 | |
|             signZ, expZ - 1, sigZ.v64, sigZ.v0, sigZExtra );
 | |
|     /*------------------------------------------------------------------------
 | |
|     *------------------------------------------------------------------------*/
 | |
|  propagateNaN_ABC:
 | |
|     uiZ = softfloat_propagateNaNF128UI( uiA64, uiA0, uiB64, uiB0 );
 | |
|     goto propagateNaN_ZC;
 | |
|     /*------------------------------------------------------------------------
 | |
|     *------------------------------------------------------------------------*/
 | |
|  infProdArg:
 | |
|     if ( magBits ) {
 | |
|         uiZ.v64 = packToF128UI64( signZ, 0x7FFF, 0 );
 | |
|         uiZ.v0 = 0;
 | |
|         if ( expC != 0x7FFF ) goto uiZ;
 | |
|         if ( sigC.v64 | sigC.v0 ) goto propagateNaN_ZC;
 | |
|         if ( signZ == signC ) goto uiZ;
 | |
|     }
 | |
|     softfloat_raiseFlags( softfloat_flag_invalid );
 | |
|     uiZ.v64 = defaultNaNF128UI64;
 | |
|     uiZ.v0  = defaultNaNF128UI0;
 | |
|  propagateNaN_ZC:
 | |
|     uiZ = softfloat_propagateNaNF128UI( uiZ.v64, uiZ.v0, uiC64, uiC0 );
 | |
|     goto uiZ;
 | |
|     /*------------------------------------------------------------------------
 | |
|     *------------------------------------------------------------------------*/
 | |
|  zeroProd:
 | |
|     uiZ.v64 = uiC64;
 | |
|     uiZ.v0  = uiC0;
 | |
|     if ( ! (expC | sigC.v64 | sigC.v0) && (signZ != signC) ) {
 | |
|  completeCancellation:
 | |
|         uiZ.v64 =
 | |
|             packToF128UI64(
 | |
|                 (softfloat_roundingMode == softfloat_round_min), 0, 0 );
 | |
|         uiZ.v0 = 0;
 | |
|     }
 | |
|  uiZ:
 | |
|     uZ.ui = uiZ;
 | |
|     return uZ.f;
 | |
| 
 | |
| }
 | |
| 
 |