|  |  | @@ -0,0 +1,103 @@ | 
		
	
		
			
			|  |  |  | //copyright Michael Niedermayer 2006 license:LGPL | 
		
	
		
			
			|  |  |  | 
 | 
		
	
		
			
			|  |  |  | #define MIN_EXP -126 | 
		
	
		
			
			|  |  |  | #define MAX_EXP  126 | 
		
	
		
			
			|  |  |  | #define ONE_BITS 29 | 
		
	
		
			
			|  |  |  | 
 | 
		
	
		
			
			|  |  |  | typedef struct SoftFloat{ | 
		
	
		
			
			|  |  |  | int32_t  exp; | 
		
	
		
			
			|  |  |  | int32_t mant; | 
		
	
		
			
			|  |  |  | }SoftFloat; | 
		
	
		
			
			|  |  |  | 
 | 
		
	
		
			
			|  |  |  | static SoftFloat av_normalize_sf(SoftFloat a){ | 
		
	
		
			
			|  |  |  | if(a.mant){ | 
		
	
		
			
			|  |  |  | #if 1 | 
		
	
		
			
			|  |  |  | while((a.mant + 0x20000000U)<0x40000000U){ | 
		
	
		
			
			|  |  |  | a.mant += a.mant; | 
		
	
		
			
			|  |  |  | a.exp  -= 1; | 
		
	
		
			
			|  |  |  | } | 
		
	
		
			
			|  |  |  | #else | 
		
	
		
			
			|  |  |  | int s=ONE_BITS + 1 - av_log2(a.mant ^ (a.mant<<1)); | 
		
	
		
			
			|  |  |  | a.exp   -= s; | 
		
	
		
			
			|  |  |  | a.mant <<= s; | 
		
	
		
			
			|  |  |  | #endif | 
		
	
		
			
			|  |  |  | if(a.exp < MIN_EXP){ | 
		
	
		
			
			|  |  |  | a.exp = MIN_EXP; | 
		
	
		
			
			|  |  |  | a.mant= 0; | 
		
	
		
			
			|  |  |  | } | 
		
	
		
			
			|  |  |  | }else{ | 
		
	
		
			
			|  |  |  | a.exp= MIN_EXP; | 
		
	
		
			
			|  |  |  | } | 
		
	
		
			
			|  |  |  | return a; | 
		
	
		
			
			|  |  |  | } | 
		
	
		
			
			|  |  |  | 
 | 
		
	
		
			
			|  |  |  | static inline SoftFloat av_normalize1_sf(SoftFloat a){ | 
		
	
		
			
			|  |  |  | #if 1 | 
		
	
		
			
			|  |  |  | if(a.mant + 0x40000000 < 0){ | 
		
	
		
			
			|  |  |  | a.exp++; | 
		
	
		
			
			|  |  |  | a.mant>>=1; | 
		
	
		
			
			|  |  |  | } | 
		
	
		
			
			|  |  |  | return a; | 
		
	
		
			
			|  |  |  | #elif 1 | 
		
	
		
			
			|  |  |  | int t= a.mant + 0x40000000 < 0; | 
		
	
		
			
			|  |  |  | return (SoftFloat){a.exp+t, a.mant>>t}; | 
		
	
		
			
			|  |  |  | #else | 
		
	
		
			
			|  |  |  | int t= (a.mant + 0x40000000U)>>31; | 
		
	
		
			
			|  |  |  | return (SoftFloat){a.exp+t, a.mant>>t}; | 
		
	
		
			
			|  |  |  | #endif | 
		
	
		
			
			|  |  |  | } | 
		
	
		
			
			|  |  |  | 
 | 
		
	
		
			
			|  |  |  | /** | 
		
	
		
			
			|  |  |  | * | 
		
	
		
			
			|  |  |  | * @return will not be more denormalized then a+b, so if either input is | 
		
	
		
			
			|  |  |  | *         normalized then the output wont be worse then the other input | 
		
	
		
			
			|  |  |  | *         if both are normalized then the output will be normalized | 
		
	
		
			
			|  |  |  | */ | 
		
	
		
			
			|  |  |  | static inline SoftFloat av_mul_sf(SoftFloat a, SoftFloat b){ | 
		
	
		
			
			|  |  |  | a.exp += b.exp; | 
		
	
		
			
			|  |  |  | a.mant = (a.mant * (int64_t)b.mant) >> ONE_BITS; | 
		
	
		
			
			|  |  |  | return av_normalize1_sf(a); | 
		
	
		
			
			|  |  |  | } | 
		
	
		
			
			|  |  |  | 
 | 
		
	
		
			
			|  |  |  | /** | 
		
	
		
			
			|  |  |  | * | 
		
	
		
			
			|  |  |  | * b has to be normalized and not zero | 
		
	
		
			
			|  |  |  | * @return will not be more denormalized then a | 
		
	
		
			
			|  |  |  | */ | 
		
	
		
			
			|  |  |  | static SoftFloat av_div_sf(SoftFloat a, SoftFloat b){ | 
		
	
		
			
			|  |  |  | a.exp -= b.exp+1; | 
		
	
		
			
			|  |  |  | a.mant = ((int64_t)a.mant<<(ONE_BITS+1)) / b.mant; | 
		
	
		
			
			|  |  |  | return av_normalize1_sf(a); | 
		
	
		
			
			|  |  |  | } | 
		
	
		
			
			|  |  |  | 
 | 
		
	
		
			
			|  |  |  | static inline int av_cmp_sf(SoftFloat a, SoftFloat b){ | 
		
	
		
			
			|  |  |  | int t= a.exp - b.exp; | 
		
	
		
			
			|  |  |  | if(t<0) return (a.mant >> (-t)) -  b.mant      ; | 
		
	
		
			
			|  |  |  | else    return  a.mant          - (b.mant >> t); | 
		
	
		
			
			|  |  |  | } | 
		
	
		
			
			|  |  |  | 
 | 
		
	
		
			
			|  |  |  | static inline SoftFloat av_add_sf(SoftFloat a, SoftFloat b){ | 
		
	
		
			
			|  |  |  | int t= a.exp - b.exp; | 
		
	
		
			
			|  |  |  | if(t<0) return av_normalize1_sf((SoftFloat){b.exp, b.mant + (a.mant >> (-t))}); | 
		
	
		
			
			|  |  |  | else    return av_normalize1_sf((SoftFloat){a.exp, a.mant + (b.mant >>   t )}); | 
		
	
		
			
			|  |  |  | } | 
		
	
		
			
			|  |  |  | 
 | 
		
	
		
			
			|  |  |  | static inline SoftFloat av_sub_sf(SoftFloat a, SoftFloat b){ | 
		
	
		
			
			|  |  |  | return av_add_sf(a, (SoftFloat){b.exp, -b.mant}); | 
		
	
		
			
			|  |  |  | } | 
		
	
		
			
			|  |  |  | 
 | 
		
	
		
			
			|  |  |  | //FIXME sqrt, log, exp, pow, sin, cos | 
		
	
		
			
			|  |  |  | 
 | 
		
	
		
			
			|  |  |  | static inline SoftFloat av_int2sf(int v, int frac_bits){ | 
		
	
		
			
			|  |  |  | return av_normalize_sf((SoftFloat){ONE_BITS-frac_bits, v}); | 
		
	
		
			
			|  |  |  | } | 
		
	
		
			
			|  |  |  | 
 | 
		
	
		
			
			|  |  |  | /** | 
		
	
		
			
			|  |  |  | * | 
		
	
		
			
			|  |  |  | * rounding is to -inf | 
		
	
		
			
			|  |  |  | */ | 
		
	
		
			
			|  |  |  | static inline int av_sf2int(SoftFloat v, int frac_bits){ | 
		
	
		
			
			|  |  |  | v.exp += frac_bits - ONE_BITS; | 
		
	
		
			
			|  |  |  | if(v.exp >= 0) return v.mant <<  v.exp ; | 
		
	
		
			
			|  |  |  | else           return v.mant >>(-v.exp); | 
		
	
		
			
			|  |  |  | } |