mirror of
				https://github.com/openhwgroup/cvw
				synced 2025-02-11 06:05:49 +00:00 
			
		
		
		
	
		
			
				
	
	
		
			212 lines
		
	
	
		
			8.1 KiB
		
	
	
	
		
			C
		
	
	
	
	
	
			
		
		
	
	
			212 lines
		
	
	
		
			8.1 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 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 );
 | |
| 
 | |
| }
 | |
| 
 |