| 29,3 → 29,114 |
|---|
| |
| #include<softfloat.h> |
| |
| |
| float __addsf3(float a, float b) |
| { |
| float32 fa, fb; |
| a.f=a; |
| b.f=b; |
| if (a.parts.sign!=b.parts.sign) return subFloat32(a,b).f; |
| return addFloat32(a,b).f; |
| }; |
| |
| float __subsf3(float a, float b) |
| { |
| float32 fa, fb; |
| a.f=a; |
| b.f=b; |
| if (a.parts.sign!=b.parts.sign) return addFloat32(a,b).f; |
| return subFloat32(a,b).f; |
| }; |
| |
| float __negsf2(float a) |
| { |
| float32 fa; |
| fa.f=a; |
| fa.parts.sign=!fa.parts.sign; |
| return fa.f; |
| }; |
| |
| double __negdf2(double a) |
| { |
| float64 fa; |
| fa.f=a; |
| fa.parts.sign=!fa.parts.sign; |
| return fa.f; |
| }; |
| |
| float32 addFloat32(float32 a, float32 b) |
| { |
| __u32 expdiff; |
| __u32 exp1,exp2,mant1,mant2; |
| |
| expdiff=a.parts.exp - b.parts.exp; |
| if (expdiff<0) { |
| if (isFloat32NaN(a)) { |
| //TODO: fix it |
| return a; |
| }; |
| |
| mant1=b.parts.mantisa; |
| exp1=b.parts.exp; |
| mant2=a.parts.mantisa; |
| exp2=a.parts.exp; |
| expdiff*=-1; |
| } else { |
| if (isFloat32NaN(b)) { |
| //TODO: fix it |
| return b; |
| }; |
| mant1=a.parts.mantisa; |
| exp1=a.parts.exp; |
| mant2=b.parts.mantisa; |
| exp2=b.parts.exp; |
| }; |
| |
| // create some space for rounding |
| mant1<<=6; |
| mant2<<=6; |
| |
| if (exp1!=0) { |
| mant1|=0x20000000; //add hidden bit |
| }; |
| |
| if (exp2==0) { |
| --expdiff; |
| } else { |
| mant2|=0x20000000; //hidden bit |
| }; |
| |
| |
| if (expdiff>24) { |
| goto done; |
| }; |
| |
| mant2>>=expdiff; |
| mant1+=mant2; |
| done: |
| //TODO: round mant1 |
| a.parts.exp=exp1; |
| a.parts.mantisa=mant1>>6; |
| return a; |
| }; |
| |
| float32 subFloat32(float32 a, float32 b) |
| { |
| |
| |
| }; |
| |
| inline int isFloat32NaN(float32 f) |
| { /* NaN : exp = 0xff and nonzero mantisa */ |
| float32 fa; |
| fa.f=f; |
| return ((fa.parts.exp==0xFF)&&(fa.parts.mantisa)); |
| }; |
| |
| inline int isFloat32SigNaN(float32 f) |
| { /* SigNaN : exp = 0xff mantisa = 1xxxxx..x (binary), where at least one x is nonzero */ |
| float32 fa; |
| fa.f=f; |
| return ((fa.parts.exp==0xFF)&&(fa.parts.mantisa>0x400000)); |
| }; |
| |