compiler_builtins/float/
add.rs1use crate::float::Float;
2use crate::int::{CastFrom, CastInto, Int, MinInt};
3
4fn add<F: Float>(a: F, b: F) -> F
6where
7 u32: CastInto<F::Int>,
8 F::Int: CastInto<u32>,
9 i32: CastInto<F::Int>,
10 F::Int: CastInto<i32>,
11{
12 let one = F::Int::ONE;
13 let zero = F::Int::ZERO;
14
15 let bits: F::Int = F::BITS.cast();
16 let significand_bits = F::SIG_BITS;
17 let max_exponent = F::EXP_SAT;
18
19 let implicit_bit = F::IMPLICIT_BIT;
20 let significand_mask = F::SIG_MASK;
21 let sign_bit = F::SIGN_MASK as F::Int;
22 let abs_mask = sign_bit - one;
23 let exponent_mask = F::EXP_MASK;
24 let inf_rep = exponent_mask;
25 let quiet_bit = implicit_bit >> 1;
26 let qnan_rep = exponent_mask | quiet_bit;
27
28 let mut a_rep = a.to_bits();
29 let mut b_rep = b.to_bits();
30 let a_abs = a_rep & abs_mask;
31 let b_abs = b_rep & abs_mask;
32
33 if a_abs.wrapping_sub(one) >= inf_rep - one || b_abs.wrapping_sub(one) >= inf_rep - one {
35 if a_abs > inf_rep {
37 return F::from_bits(a_abs | quiet_bit);
38 }
39 if b_abs > inf_rep {
41 return F::from_bits(b_abs | quiet_bit);
42 }
43
44 if a_abs == inf_rep {
45 if (a.to_bits() ^ b.to_bits()) == sign_bit {
47 return F::from_bits(qnan_rep);
48 } else {
49 return a;
51 }
52 }
53
54 if b_abs == inf_rep {
56 return b;
57 }
58
59 if a_abs == MinInt::ZERO {
61 if b_abs == MinInt::ZERO {
63 return F::from_bits(a.to_bits() & b.to_bits());
64 } else {
65 return b;
66 }
67 }
68
69 if b_abs == MinInt::ZERO {
71 return a;
72 }
73 }
74
75 if b_abs > a_abs {
77 let tmp = a_rep;
79 a_rep = b_rep;
80 b_rep = tmp;
81 }
82
83 let mut a_exponent: i32 = ((a_rep & exponent_mask) >> significand_bits).cast();
85 let mut b_exponent: i32 = ((b_rep & exponent_mask) >> significand_bits).cast();
86 let mut a_significand = a_rep & significand_mask;
87 let mut b_significand = b_rep & significand_mask;
88
89 if a_exponent == 0 {
91 let (exponent, significand) = F::normalize(a_significand);
92 a_exponent = exponent;
93 a_significand = significand;
94 }
95 if b_exponent == 0 {
96 let (exponent, significand) = F::normalize(b_significand);
97 b_exponent = exponent;
98 b_significand = significand;
99 }
100
101 let result_sign = a_rep & sign_bit;
104 let subtraction = ((a_rep ^ b_rep) & sign_bit) != zero;
105
106 a_significand = (a_significand | implicit_bit) << 3;
111 b_significand = (b_significand | implicit_bit) << 3;
112
113 let align = a_exponent.wrapping_sub(b_exponent).cast();
116 if align != MinInt::ZERO {
117 if align < bits {
118 let sticky = F::Int::from_bool(
119 b_significand << u32::cast_from(bits.wrapping_sub(align)) != MinInt::ZERO,
120 );
121 b_significand = (b_significand >> u32::cast_from(align)) | sticky;
122 } else {
123 b_significand = one; }
125 }
126 if subtraction {
127 a_significand = a_significand.wrapping_sub(b_significand);
128 if a_significand == MinInt::ZERO {
130 return F::from_bits(MinInt::ZERO);
131 }
132
133 if a_significand < implicit_bit << 3 {
136 let shift = a_significand.leading_zeros() as i32
137 - (implicit_bit << 3u32).leading_zeros() as i32;
138 a_significand <<= shift;
139 a_exponent -= shift;
140 }
141 } else {
142 a_significand += b_significand;
144
145 if a_significand & (implicit_bit << 4) != MinInt::ZERO {
148 let sticky = F::Int::from_bool(a_significand & one != MinInt::ZERO);
149 a_significand = (a_significand >> 1) | sticky;
150 a_exponent += 1;
151 }
152 }
153
154 if a_exponent >= max_exponent as i32 {
156 return F::from_bits(inf_rep | result_sign);
157 }
158
159 if a_exponent <= 0 {
160 let shift = (1 - a_exponent).cast();
163 let sticky = F::Int::from_bool(
164 (a_significand << u32::cast_from(bits.wrapping_sub(shift))) != MinInt::ZERO,
165 );
166 a_significand = (a_significand >> u32::cast_from(shift)) | sticky;
167 a_exponent = 0;
168 }
169
170 let a_significand_i32: i32 = a_significand.cast_lossy();
172 let round_guard_sticky: i32 = a_significand_i32 & 0x7;
173
174 let mut result = (a_significand >> 3) & significand_mask;
176
177 result |= a_exponent.cast() << significand_bits;
179 result |= result_sign;
180
181 if round_guard_sticky > 0x4 {
184 result += one;
185 }
186 if round_guard_sticky == 0x4 {
187 result += result & one;
188 }
189
190 F::from_bits(result)
191}
192
193intrinsics! {
194 #[aapcs_on_arm]
195 #[arm_aeabi_alias = __aeabi_fadd]
196 pub extern "C" fn __addsf3(a: f32, b: f32) -> f32 {
197 add(a, b)
198 }
199
200 #[aapcs_on_arm]
201 #[arm_aeabi_alias = __aeabi_dadd]
202 pub extern "C" fn __adddf3(a: f64, b: f64) -> f64 {
203 add(a, b)
204 }
205
206 #[ppc_alias = __addkf3]
207 #[cfg(f128_enabled)]
208 pub extern "C" fn __addtf3(a: f128, b: f128) -> f128 {
209 add(a, b)
210 }
211}