0
|
1 /* Software floating-point emulation.
|
|
2 Basic four-word fraction declaration and manipulation.
|
|
3 Copyright (C) 1997,1998,1999,2006,2007 Free Software Foundation, Inc.
|
|
4 This file is part of the GNU C Library.
|
|
5 Contributed by Richard Henderson (rth@cygnus.com),
|
|
6 Jakub Jelinek (jj@ultra.linux.cz),
|
|
7 David S. Miller (davem@redhat.com) and
|
|
8 Peter Maydell (pmaydell@chiark.greenend.org.uk).
|
|
9
|
|
10 The GNU C Library is free software; you can redistribute it and/or
|
|
11 modify it under the terms of the GNU Lesser General Public
|
|
12 License as published by the Free Software Foundation; either
|
|
13 version 2.1 of the License, or (at your option) any later version.
|
|
14
|
|
15 In addition to the permissions in the GNU Lesser General Public
|
|
16 License, the Free Software Foundation gives you unlimited
|
|
17 permission to link the compiled version of this file into
|
|
18 combinations with other programs, and to distribute those
|
|
19 combinations without any restriction coming from the use of this
|
|
20 file. (The Lesser General Public License restrictions do apply in
|
|
21 other respects; for example, they cover modification of the file,
|
|
22 and distribution when not linked into a combine executable.)
|
|
23
|
|
24 The GNU C Library is distributed in the hope that it will be useful,
|
|
25 but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
26 MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
|
|
27 Lesser General Public License for more details.
|
|
28
|
|
29 You should have received a copy of the GNU Lesser General Public
|
|
30 License along with the GNU C Library; if not, write to the Free
|
|
31 Software Foundation, 51 Franklin Street, Fifth Floor, Boston,
|
|
32 MA 02110-1301, USA. */
|
|
33
|
|
34 #define _FP_FRAC_DECL_4(X) _FP_W_TYPE X##_f[4]
|
|
35 #define _FP_FRAC_COPY_4(D,S) \
|
|
36 (D##_f[0] = S##_f[0], D##_f[1] = S##_f[1], \
|
|
37 D##_f[2] = S##_f[2], D##_f[3] = S##_f[3])
|
|
38 #define _FP_FRAC_SET_4(X,I) __FP_FRAC_SET_4(X, I)
|
|
39 #define _FP_FRAC_HIGH_4(X) (X##_f[3])
|
|
40 #define _FP_FRAC_LOW_4(X) (X##_f[0])
|
|
41 #define _FP_FRAC_WORD_4(X,w) (X##_f[w])
|
|
42
|
|
43 #define _FP_FRAC_SLL_4(X,N) \
|
|
44 do { \
|
|
45 _FP_I_TYPE _up, _down, _skip, _i; \
|
|
46 _skip = (N) / _FP_W_TYPE_SIZE; \
|
|
47 _up = (N) % _FP_W_TYPE_SIZE; \
|
|
48 _down = _FP_W_TYPE_SIZE - _up; \
|
|
49 if (!_up) \
|
|
50 for (_i = 3; _i >= _skip; --_i) \
|
|
51 X##_f[_i] = X##_f[_i-_skip]; \
|
|
52 else \
|
|
53 { \
|
|
54 for (_i = 3; _i > _skip; --_i) \
|
|
55 X##_f[_i] = X##_f[_i-_skip] << _up \
|
|
56 | X##_f[_i-_skip-1] >> _down; \
|
|
57 X##_f[_i--] = X##_f[0] << _up; \
|
|
58 } \
|
|
59 for (; _i >= 0; --_i) \
|
|
60 X##_f[_i] = 0; \
|
|
61 } while (0)
|
|
62
|
|
63 /* This one was broken too */
|
|
64 #define _FP_FRAC_SRL_4(X,N) \
|
|
65 do { \
|
|
66 _FP_I_TYPE _up, _down, _skip, _i; \
|
|
67 _skip = (N) / _FP_W_TYPE_SIZE; \
|
|
68 _down = (N) % _FP_W_TYPE_SIZE; \
|
|
69 _up = _FP_W_TYPE_SIZE - _down; \
|
|
70 if (!_down) \
|
|
71 for (_i = 0; _i <= 3-_skip; ++_i) \
|
|
72 X##_f[_i] = X##_f[_i+_skip]; \
|
|
73 else \
|
|
74 { \
|
|
75 for (_i = 0; _i < 3-_skip; ++_i) \
|
|
76 X##_f[_i] = X##_f[_i+_skip] >> _down \
|
|
77 | X##_f[_i+_skip+1] << _up; \
|
|
78 X##_f[_i++] = X##_f[3] >> _down; \
|
|
79 } \
|
|
80 for (; _i < 4; ++_i) \
|
|
81 X##_f[_i] = 0; \
|
|
82 } while (0)
|
|
83
|
|
84
|
|
85 /* Right shift with sticky-lsb.
|
|
86 * What this actually means is that we do a standard right-shift,
|
|
87 * but that if any of the bits that fall off the right hand side
|
|
88 * were one then we always set the LSbit.
|
|
89 */
|
|
90 #define _FP_FRAC_SRST_4(X,S,N,size) \
|
|
91 do { \
|
|
92 _FP_I_TYPE _up, _down, _skip, _i; \
|
|
93 _FP_W_TYPE _s; \
|
|
94 _skip = (N) / _FP_W_TYPE_SIZE; \
|
|
95 _down = (N) % _FP_W_TYPE_SIZE; \
|
|
96 _up = _FP_W_TYPE_SIZE - _down; \
|
|
97 for (_s = _i = 0; _i < _skip; ++_i) \
|
|
98 _s |= X##_f[_i]; \
|
|
99 if (!_down) \
|
|
100 for (_i = 0; _i <= 3-_skip; ++_i) \
|
|
101 X##_f[_i] = X##_f[_i+_skip]; \
|
|
102 else \
|
|
103 { \
|
|
104 _s |= X##_f[_i] << _up; \
|
|
105 for (_i = 0; _i < 3-_skip; ++_i) \
|
|
106 X##_f[_i] = X##_f[_i+_skip] >> _down \
|
|
107 | X##_f[_i+_skip+1] << _up; \
|
|
108 X##_f[_i++] = X##_f[3] >> _down; \
|
|
109 } \
|
|
110 for (; _i < 4; ++_i) \
|
|
111 X##_f[_i] = 0; \
|
|
112 S = (_s != 0); \
|
|
113 } while (0)
|
|
114
|
|
115 #define _FP_FRAC_SRS_4(X,N,size) \
|
|
116 do { \
|
|
117 int _sticky; \
|
|
118 _FP_FRAC_SRST_4(X, _sticky, N, size); \
|
|
119 X##_f[0] |= _sticky; \
|
|
120 } while (0)
|
|
121
|
|
122 #define _FP_FRAC_ADD_4(R,X,Y) \
|
|
123 __FP_FRAC_ADD_4(R##_f[3], R##_f[2], R##_f[1], R##_f[0], \
|
|
124 X##_f[3], X##_f[2], X##_f[1], X##_f[0], \
|
|
125 Y##_f[3], Y##_f[2], Y##_f[1], Y##_f[0])
|
|
126
|
|
127 #define _FP_FRAC_SUB_4(R,X,Y) \
|
|
128 __FP_FRAC_SUB_4(R##_f[3], R##_f[2], R##_f[1], R##_f[0], \
|
|
129 X##_f[3], X##_f[2], X##_f[1], X##_f[0], \
|
|
130 Y##_f[3], Y##_f[2], Y##_f[1], Y##_f[0])
|
|
131
|
|
132 #define _FP_FRAC_DEC_4(X,Y) \
|
|
133 __FP_FRAC_DEC_4(X##_f[3], X##_f[2], X##_f[1], X##_f[0], \
|
|
134 Y##_f[3], Y##_f[2], Y##_f[1], Y##_f[0])
|
|
135
|
|
136 #define _FP_FRAC_ADDI_4(X,I) \
|
|
137 __FP_FRAC_ADDI_4(X##_f[3], X##_f[2], X##_f[1], X##_f[0], I)
|
|
138
|
|
139 #define _FP_ZEROFRAC_4 0,0,0,0
|
|
140 #define _FP_MINFRAC_4 0,0,0,1
|
|
141 #define _FP_MAXFRAC_4 (~(_FP_WS_TYPE)0), (~(_FP_WS_TYPE)0), (~(_FP_WS_TYPE)0), (~(_FP_WS_TYPE)0)
|
|
142
|
|
143 #define _FP_FRAC_ZEROP_4(X) ((X##_f[0] | X##_f[1] | X##_f[2] | X##_f[3]) == 0)
|
|
144 #define _FP_FRAC_NEGP_4(X) ((_FP_WS_TYPE)X##_f[3] < 0)
|
|
145 #define _FP_FRAC_OVERP_4(fs,X) (_FP_FRAC_HIGH_##fs(X) & _FP_OVERFLOW_##fs)
|
|
146 #define _FP_FRAC_CLEAR_OVERP_4(fs,X) (_FP_FRAC_HIGH_##fs(X) &= ~_FP_OVERFLOW_##fs)
|
|
147
|
|
148 #define _FP_FRAC_EQ_4(X,Y) \
|
|
149 (X##_f[0] == Y##_f[0] && X##_f[1] == Y##_f[1] \
|
|
150 && X##_f[2] == Y##_f[2] && X##_f[3] == Y##_f[3])
|
|
151
|
|
152 #define _FP_FRAC_GT_4(X,Y) \
|
|
153 (X##_f[3] > Y##_f[3] || \
|
|
154 (X##_f[3] == Y##_f[3] && (X##_f[2] > Y##_f[2] || \
|
|
155 (X##_f[2] == Y##_f[2] && (X##_f[1] > Y##_f[1] || \
|
|
156 (X##_f[1] == Y##_f[1] && X##_f[0] > Y##_f[0]) \
|
|
157 )) \
|
|
158 )) \
|
|
159 )
|
|
160
|
|
161 #define _FP_FRAC_GE_4(X,Y) \
|
|
162 (X##_f[3] > Y##_f[3] || \
|
|
163 (X##_f[3] == Y##_f[3] && (X##_f[2] > Y##_f[2] || \
|
|
164 (X##_f[2] == Y##_f[2] && (X##_f[1] > Y##_f[1] || \
|
|
165 (X##_f[1] == Y##_f[1] && X##_f[0] >= Y##_f[0]) \
|
|
166 )) \
|
|
167 )) \
|
|
168 )
|
|
169
|
|
170
|
|
171 #define _FP_FRAC_CLZ_4(R,X) \
|
|
172 do { \
|
|
173 if (X##_f[3]) \
|
|
174 { \
|
|
175 __FP_CLZ(R,X##_f[3]); \
|
|
176 } \
|
|
177 else if (X##_f[2]) \
|
|
178 { \
|
|
179 __FP_CLZ(R,X##_f[2]); \
|
|
180 R += _FP_W_TYPE_SIZE; \
|
|
181 } \
|
|
182 else if (X##_f[1]) \
|
|
183 { \
|
|
184 __FP_CLZ(R,X##_f[1]); \
|
|
185 R += _FP_W_TYPE_SIZE*2; \
|
|
186 } \
|
|
187 else \
|
|
188 { \
|
|
189 __FP_CLZ(R,X##_f[0]); \
|
|
190 R += _FP_W_TYPE_SIZE*3; \
|
|
191 } \
|
|
192 } while(0)
|
|
193
|
|
194
|
|
195 #define _FP_UNPACK_RAW_4(fs, X, val) \
|
|
196 do { \
|
|
197 union _FP_UNION_##fs _flo; _flo.flt = (val); \
|
|
198 X##_f[0] = _flo.bits.frac0; \
|
|
199 X##_f[1] = _flo.bits.frac1; \
|
|
200 X##_f[2] = _flo.bits.frac2; \
|
|
201 X##_f[3] = _flo.bits.frac3; \
|
|
202 X##_e = _flo.bits.exp; \
|
|
203 X##_s = _flo.bits.sign; \
|
|
204 } while (0)
|
|
205
|
|
206 #define _FP_UNPACK_RAW_4_P(fs, X, val) \
|
|
207 do { \
|
|
208 union _FP_UNION_##fs *_flo = \
|
|
209 (union _FP_UNION_##fs *)(val); \
|
|
210 \
|
|
211 X##_f[0] = _flo->bits.frac0; \
|
|
212 X##_f[1] = _flo->bits.frac1; \
|
|
213 X##_f[2] = _flo->bits.frac2; \
|
|
214 X##_f[3] = _flo->bits.frac3; \
|
|
215 X##_e = _flo->bits.exp; \
|
|
216 X##_s = _flo->bits.sign; \
|
|
217 } while (0)
|
|
218
|
|
219 #define _FP_PACK_RAW_4(fs, val, X) \
|
|
220 do { \
|
|
221 union _FP_UNION_##fs _flo; \
|
|
222 _flo.bits.frac0 = X##_f[0]; \
|
|
223 _flo.bits.frac1 = X##_f[1]; \
|
|
224 _flo.bits.frac2 = X##_f[2]; \
|
|
225 _flo.bits.frac3 = X##_f[3]; \
|
|
226 _flo.bits.exp = X##_e; \
|
|
227 _flo.bits.sign = X##_s; \
|
|
228 (val) = _flo.flt; \
|
|
229 } while (0)
|
|
230
|
|
231 #define _FP_PACK_RAW_4_P(fs, val, X) \
|
|
232 do { \
|
|
233 union _FP_UNION_##fs *_flo = \
|
|
234 (union _FP_UNION_##fs *)(val); \
|
|
235 \
|
|
236 _flo->bits.frac0 = X##_f[0]; \
|
|
237 _flo->bits.frac1 = X##_f[1]; \
|
|
238 _flo->bits.frac2 = X##_f[2]; \
|
|
239 _flo->bits.frac3 = X##_f[3]; \
|
|
240 _flo->bits.exp = X##_e; \
|
|
241 _flo->bits.sign = X##_s; \
|
|
242 } while (0)
|
|
243
|
|
244 /*
|
|
245 * Multiplication algorithms:
|
|
246 */
|
|
247
|
|
248 /* Given a 1W * 1W => 2W primitive, do the extended multiplication. */
|
|
249
|
|
250 #define _FP_MUL_MEAT_4_wide(wfracbits, R, X, Y, doit) \
|
|
251 do { \
|
|
252 _FP_FRAC_DECL_8(_z); _FP_FRAC_DECL_2(_b); _FP_FRAC_DECL_2(_c); \
|
|
253 _FP_FRAC_DECL_2(_d); _FP_FRAC_DECL_2(_e); _FP_FRAC_DECL_2(_f); \
|
|
254 \
|
|
255 doit(_FP_FRAC_WORD_8(_z,1), _FP_FRAC_WORD_8(_z,0), X##_f[0], Y##_f[0]); \
|
|
256 doit(_b_f1, _b_f0, X##_f[0], Y##_f[1]); \
|
|
257 doit(_c_f1, _c_f0, X##_f[1], Y##_f[0]); \
|
|
258 doit(_d_f1, _d_f0, X##_f[1], Y##_f[1]); \
|
|
259 doit(_e_f1, _e_f0, X##_f[0], Y##_f[2]); \
|
|
260 doit(_f_f1, _f_f0, X##_f[2], Y##_f[0]); \
|
|
261 __FP_FRAC_ADD_3(_FP_FRAC_WORD_8(_z,3),_FP_FRAC_WORD_8(_z,2), \
|
|
262 _FP_FRAC_WORD_8(_z,1), 0,_b_f1,_b_f0, \
|
|
263 0,0,_FP_FRAC_WORD_8(_z,1)); \
|
|
264 __FP_FRAC_ADD_3(_FP_FRAC_WORD_8(_z,3),_FP_FRAC_WORD_8(_z,2), \
|
|
265 _FP_FRAC_WORD_8(_z,1), 0,_c_f1,_c_f0, \
|
|
266 _FP_FRAC_WORD_8(_z,3),_FP_FRAC_WORD_8(_z,2), \
|
|
267 _FP_FRAC_WORD_8(_z,1)); \
|
|
268 __FP_FRAC_ADD_3(_FP_FRAC_WORD_8(_z,4),_FP_FRAC_WORD_8(_z,3), \
|
|
269 _FP_FRAC_WORD_8(_z,2), 0,_d_f1,_d_f0, \
|
|
270 0,_FP_FRAC_WORD_8(_z,3),_FP_FRAC_WORD_8(_z,2)); \
|
|
271 __FP_FRAC_ADD_3(_FP_FRAC_WORD_8(_z,4),_FP_FRAC_WORD_8(_z,3), \
|
|
272 _FP_FRAC_WORD_8(_z,2), 0,_e_f1,_e_f0, \
|
|
273 _FP_FRAC_WORD_8(_z,4),_FP_FRAC_WORD_8(_z,3), \
|
|
274 _FP_FRAC_WORD_8(_z,2)); \
|
|
275 __FP_FRAC_ADD_3(_FP_FRAC_WORD_8(_z,4),_FP_FRAC_WORD_8(_z,3), \
|
|
276 _FP_FRAC_WORD_8(_z,2), 0,_f_f1,_f_f0, \
|
|
277 _FP_FRAC_WORD_8(_z,4),_FP_FRAC_WORD_8(_z,3), \
|
|
278 _FP_FRAC_WORD_8(_z,2)); \
|
|
279 doit(_b_f1, _b_f0, X##_f[0], Y##_f[3]); \
|
|
280 doit(_c_f1, _c_f0, X##_f[3], Y##_f[0]); \
|
|
281 doit(_d_f1, _d_f0, X##_f[1], Y##_f[2]); \
|
|
282 doit(_e_f1, _e_f0, X##_f[2], Y##_f[1]); \
|
|
283 __FP_FRAC_ADD_3(_FP_FRAC_WORD_8(_z,5),_FP_FRAC_WORD_8(_z,4), \
|
|
284 _FP_FRAC_WORD_8(_z,3), 0,_b_f1,_b_f0, \
|
|
285 0,_FP_FRAC_WORD_8(_z,4),_FP_FRAC_WORD_8(_z,3)); \
|
|
286 __FP_FRAC_ADD_3(_FP_FRAC_WORD_8(_z,5),_FP_FRAC_WORD_8(_z,4), \
|
|
287 _FP_FRAC_WORD_8(_z,3), 0,_c_f1,_c_f0, \
|
|
288 _FP_FRAC_WORD_8(_z,5),_FP_FRAC_WORD_8(_z,4), \
|
|
289 _FP_FRAC_WORD_8(_z,3)); \
|
|
290 __FP_FRAC_ADD_3(_FP_FRAC_WORD_8(_z,5),_FP_FRAC_WORD_8(_z,4), \
|
|
291 _FP_FRAC_WORD_8(_z,3), 0,_d_f1,_d_f0, \
|
|
292 _FP_FRAC_WORD_8(_z,5),_FP_FRAC_WORD_8(_z,4), \
|
|
293 _FP_FRAC_WORD_8(_z,3)); \
|
|
294 __FP_FRAC_ADD_3(_FP_FRAC_WORD_8(_z,5),_FP_FRAC_WORD_8(_z,4), \
|
|
295 _FP_FRAC_WORD_8(_z,3), 0,_e_f1,_e_f0, \
|
|
296 _FP_FRAC_WORD_8(_z,5),_FP_FRAC_WORD_8(_z,4), \
|
|
297 _FP_FRAC_WORD_8(_z,3)); \
|
|
298 doit(_b_f1, _b_f0, X##_f[2], Y##_f[2]); \
|
|
299 doit(_c_f1, _c_f0, X##_f[1], Y##_f[3]); \
|
|
300 doit(_d_f1, _d_f0, X##_f[3], Y##_f[1]); \
|
|
301 doit(_e_f1, _e_f0, X##_f[2], Y##_f[3]); \
|
|
302 doit(_f_f1, _f_f0, X##_f[3], Y##_f[2]); \
|
|
303 __FP_FRAC_ADD_3(_FP_FRAC_WORD_8(_z,6),_FP_FRAC_WORD_8(_z,5), \
|
|
304 _FP_FRAC_WORD_8(_z,4), 0,_b_f1,_b_f0, \
|
|
305 0,_FP_FRAC_WORD_8(_z,5),_FP_FRAC_WORD_8(_z,4)); \
|
|
306 __FP_FRAC_ADD_3(_FP_FRAC_WORD_8(_z,6),_FP_FRAC_WORD_8(_z,5), \
|
|
307 _FP_FRAC_WORD_8(_z,4), 0,_c_f1,_c_f0, \
|
|
308 _FP_FRAC_WORD_8(_z,6),_FP_FRAC_WORD_8(_z,5), \
|
|
309 _FP_FRAC_WORD_8(_z,4)); \
|
|
310 __FP_FRAC_ADD_3(_FP_FRAC_WORD_8(_z,6),_FP_FRAC_WORD_8(_z,5), \
|
|
311 _FP_FRAC_WORD_8(_z,4), 0,_d_f1,_d_f0, \
|
|
312 _FP_FRAC_WORD_8(_z,6),_FP_FRAC_WORD_8(_z,5), \
|
|
313 _FP_FRAC_WORD_8(_z,4)); \
|
|
314 __FP_FRAC_ADD_3(_FP_FRAC_WORD_8(_z,7),_FP_FRAC_WORD_8(_z,6), \
|
|
315 _FP_FRAC_WORD_8(_z,5), 0,_e_f1,_e_f0, \
|
|
316 0,_FP_FRAC_WORD_8(_z,6),_FP_FRAC_WORD_8(_z,5)); \
|
|
317 __FP_FRAC_ADD_3(_FP_FRAC_WORD_8(_z,7),_FP_FRAC_WORD_8(_z,6), \
|
|
318 _FP_FRAC_WORD_8(_z,5), 0,_f_f1,_f_f0, \
|
|
319 _FP_FRAC_WORD_8(_z,7),_FP_FRAC_WORD_8(_z,6), \
|
|
320 _FP_FRAC_WORD_8(_z,5)); \
|
|
321 doit(_b_f1, _b_f0, X##_f[3], Y##_f[3]); \
|
|
322 __FP_FRAC_ADD_2(_FP_FRAC_WORD_8(_z,7),_FP_FRAC_WORD_8(_z,6), \
|
|
323 _b_f1,_b_f0, \
|
|
324 _FP_FRAC_WORD_8(_z,7),_FP_FRAC_WORD_8(_z,6)); \
|
|
325 \
|
|
326 /* Normalize since we know where the msb of the multiplicands \
|
|
327 were (bit B), we know that the msb of the of the product is \
|
|
328 at either 2B or 2B-1. */ \
|
|
329 _FP_FRAC_SRS_8(_z, wfracbits-1, 2*wfracbits); \
|
|
330 __FP_FRAC_SET_4(R, _FP_FRAC_WORD_8(_z,3), _FP_FRAC_WORD_8(_z,2), \
|
|
331 _FP_FRAC_WORD_8(_z,1), _FP_FRAC_WORD_8(_z,0)); \
|
|
332 } while (0)
|
|
333
|
|
334 #define _FP_MUL_MEAT_4_gmp(wfracbits, R, X, Y) \
|
|
335 do { \
|
|
336 _FP_FRAC_DECL_8(_z); \
|
|
337 \
|
|
338 mpn_mul_n(_z_f, _x_f, _y_f, 4); \
|
|
339 \
|
|
340 /* Normalize since we know where the msb of the multiplicands \
|
|
341 were (bit B), we know that the msb of the of the product is \
|
|
342 at either 2B or 2B-1. */ \
|
|
343 _FP_FRAC_SRS_8(_z, wfracbits-1, 2*wfracbits); \
|
|
344 __FP_FRAC_SET_4(R, _FP_FRAC_WORD_8(_z,3), _FP_FRAC_WORD_8(_z,2), \
|
|
345 _FP_FRAC_WORD_8(_z,1), _FP_FRAC_WORD_8(_z,0)); \
|
|
346 } while (0)
|
|
347
|
|
348 /*
|
|
349 * Helper utility for _FP_DIV_MEAT_4_udiv:
|
|
350 * pppp = m * nnn
|
|
351 */
|
|
352 #define umul_ppppmnnn(p3,p2,p1,p0,m,n2,n1,n0) \
|
|
353 do { \
|
|
354 UWtype _t; \
|
|
355 umul_ppmm(p1,p0,m,n0); \
|
|
356 umul_ppmm(p2,_t,m,n1); \
|
|
357 __FP_FRAC_ADDI_2(p2,p1,_t); \
|
|
358 umul_ppmm(p3,_t,m,n2); \
|
|
359 __FP_FRAC_ADDI_2(p3,p2,_t); \
|
|
360 } while (0)
|
|
361
|
|
362 /*
|
|
363 * Division algorithms:
|
|
364 */
|
|
365
|
|
366 #define _FP_DIV_MEAT_4_udiv(fs, R, X, Y) \
|
|
367 do { \
|
|
368 int _i; \
|
|
369 _FP_FRAC_DECL_4(_n); _FP_FRAC_DECL_4(_m); \
|
|
370 _FP_FRAC_SET_4(_n, _FP_ZEROFRAC_4); \
|
|
371 if (_FP_FRAC_GT_4(X, Y)) \
|
|
372 { \
|
|
373 _n_f[3] = X##_f[0] << (_FP_W_TYPE_SIZE - 1); \
|
|
374 _FP_FRAC_SRL_4(X, 1); \
|
|
375 } \
|
|
376 else \
|
|
377 R##_e--; \
|
|
378 \
|
|
379 /* Normalize, i.e. make the most significant bit of the \
|
|
380 denominator set. */ \
|
|
381 _FP_FRAC_SLL_4(Y, _FP_WFRACXBITS_##fs); \
|
|
382 \
|
|
383 for (_i = 3; ; _i--) \
|
|
384 { \
|
|
385 if (X##_f[3] == Y##_f[3]) \
|
|
386 { \
|
|
387 /* This is a special case, not an optimization \
|
|
388 (X##_f[3]/Y##_f[3] would not fit into UWtype). \
|
|
389 As X## is guaranteed to be < Y, R##_f[_i] can be either \
|
|
390 (UWtype)-1 or (UWtype)-2. */ \
|
|
391 R##_f[_i] = -1; \
|
|
392 if (!_i) \
|
|
393 break; \
|
|
394 __FP_FRAC_SUB_4(X##_f[3], X##_f[2], X##_f[1], X##_f[0], \
|
|
395 Y##_f[2], Y##_f[1], Y##_f[0], 0, \
|
|
396 X##_f[2], X##_f[1], X##_f[0], _n_f[_i]); \
|
|
397 _FP_FRAC_SUB_4(X, Y, X); \
|
|
398 if (X##_f[3] > Y##_f[3]) \
|
|
399 { \
|
|
400 R##_f[_i] = -2; \
|
|
401 _FP_FRAC_ADD_4(X, Y, X); \
|
|
402 } \
|
|
403 } \
|
|
404 else \
|
|
405 { \
|
|
406 udiv_qrnnd(R##_f[_i], X##_f[3], X##_f[3], X##_f[2], Y##_f[3]); \
|
|
407 umul_ppppmnnn(_m_f[3], _m_f[2], _m_f[1], _m_f[0], \
|
|
408 R##_f[_i], Y##_f[2], Y##_f[1], Y##_f[0]); \
|
|
409 X##_f[2] = X##_f[1]; \
|
|
410 X##_f[1] = X##_f[0]; \
|
|
411 X##_f[0] = _n_f[_i]; \
|
|
412 if (_FP_FRAC_GT_4(_m, X)) \
|
|
413 { \
|
|
414 R##_f[_i]--; \
|
|
415 _FP_FRAC_ADD_4(X, Y, X); \
|
|
416 if (_FP_FRAC_GE_4(X, Y) && _FP_FRAC_GT_4(_m, X)) \
|
|
417 { \
|
|
418 R##_f[_i]--; \
|
|
419 _FP_FRAC_ADD_4(X, Y, X); \
|
|
420 } \
|
|
421 } \
|
|
422 _FP_FRAC_DEC_4(X, _m); \
|
|
423 if (!_i) \
|
|
424 { \
|
|
425 if (!_FP_FRAC_EQ_4(X, _m)) \
|
|
426 R##_f[0] |= _FP_WORK_STICKY; \
|
|
427 break; \
|
|
428 } \
|
|
429 } \
|
|
430 } \
|
|
431 } while (0)
|
|
432
|
|
433
|
|
434 /*
|
|
435 * Square root algorithms:
|
|
436 * We have just one right now, maybe Newton approximation
|
|
437 * should be added for those machines where division is fast.
|
|
438 */
|
|
439
|
|
440 #define _FP_SQRT_MEAT_4(R, S, T, X, q) \
|
|
441 do { \
|
|
442 while (q) \
|
|
443 { \
|
|
444 T##_f[3] = S##_f[3] + q; \
|
|
445 if (T##_f[3] <= X##_f[3]) \
|
|
446 { \
|
|
447 S##_f[3] = T##_f[3] + q; \
|
|
448 X##_f[3] -= T##_f[3]; \
|
|
449 R##_f[3] += q; \
|
|
450 } \
|
|
451 _FP_FRAC_SLL_4(X, 1); \
|
|
452 q >>= 1; \
|
|
453 } \
|
|
454 q = (_FP_W_TYPE)1 << (_FP_W_TYPE_SIZE - 1); \
|
|
455 while (q) \
|
|
456 { \
|
|
457 T##_f[2] = S##_f[2] + q; \
|
|
458 T##_f[3] = S##_f[3]; \
|
|
459 if (T##_f[3] < X##_f[3] || \
|
|
460 (T##_f[3] == X##_f[3] && T##_f[2] <= X##_f[2])) \
|
|
461 { \
|
|
462 S##_f[2] = T##_f[2] + q; \
|
|
463 S##_f[3] += (T##_f[2] > S##_f[2]); \
|
|
464 __FP_FRAC_DEC_2(X##_f[3], X##_f[2], \
|
|
465 T##_f[3], T##_f[2]); \
|
|
466 R##_f[2] += q; \
|
|
467 } \
|
|
468 _FP_FRAC_SLL_4(X, 1); \
|
|
469 q >>= 1; \
|
|
470 } \
|
|
471 q = (_FP_W_TYPE)1 << (_FP_W_TYPE_SIZE - 1); \
|
|
472 while (q) \
|
|
473 { \
|
|
474 T##_f[1] = S##_f[1] + q; \
|
|
475 T##_f[2] = S##_f[2]; \
|
|
476 T##_f[3] = S##_f[3]; \
|
|
477 if (T##_f[3] < X##_f[3] || \
|
|
478 (T##_f[3] == X##_f[3] && (T##_f[2] < X##_f[2] || \
|
|
479 (T##_f[2] == X##_f[2] && T##_f[1] <= X##_f[1])))) \
|
|
480 { \
|
|
481 S##_f[1] = T##_f[1] + q; \
|
|
482 S##_f[2] += (T##_f[1] > S##_f[1]); \
|
|
483 S##_f[3] += (T##_f[2] > S##_f[2]); \
|
|
484 __FP_FRAC_DEC_3(X##_f[3], X##_f[2], X##_f[1], \
|
|
485 T##_f[3], T##_f[2], T##_f[1]); \
|
|
486 R##_f[1] += q; \
|
|
487 } \
|
|
488 _FP_FRAC_SLL_4(X, 1); \
|
|
489 q >>= 1; \
|
|
490 } \
|
|
491 q = (_FP_W_TYPE)1 << (_FP_W_TYPE_SIZE - 1); \
|
|
492 while (q != _FP_WORK_ROUND) \
|
|
493 { \
|
|
494 T##_f[0] = S##_f[0] + q; \
|
|
495 T##_f[1] = S##_f[1]; \
|
|
496 T##_f[2] = S##_f[2]; \
|
|
497 T##_f[3] = S##_f[3]; \
|
|
498 if (_FP_FRAC_GE_4(X,T)) \
|
|
499 { \
|
|
500 S##_f[0] = T##_f[0] + q; \
|
|
501 S##_f[1] += (T##_f[0] > S##_f[0]); \
|
|
502 S##_f[2] += (T##_f[1] > S##_f[1]); \
|
|
503 S##_f[3] += (T##_f[2] > S##_f[2]); \
|
|
504 _FP_FRAC_DEC_4(X, T); \
|
|
505 R##_f[0] += q; \
|
|
506 } \
|
|
507 _FP_FRAC_SLL_4(X, 1); \
|
|
508 q >>= 1; \
|
|
509 } \
|
|
510 if (!_FP_FRAC_ZEROP_4(X)) \
|
|
511 { \
|
|
512 if (_FP_FRAC_GT_4(X,S)) \
|
|
513 R##_f[0] |= _FP_WORK_ROUND; \
|
|
514 R##_f[0] |= _FP_WORK_STICKY; \
|
|
515 } \
|
|
516 } while (0)
|
|
517
|
|
518
|
|
519 /*
|
|
520 * Internals
|
|
521 */
|
|
522
|
|
523 #define __FP_FRAC_SET_4(X,I3,I2,I1,I0) \
|
|
524 (X##_f[3] = I3, X##_f[2] = I2, X##_f[1] = I1, X##_f[0] = I0)
|
|
525
|
|
526 #ifndef __FP_FRAC_ADD_3
|
|
527 #define __FP_FRAC_ADD_3(r2,r1,r0,x2,x1,x0,y2,y1,y0) \
|
|
528 do { \
|
|
529 _FP_W_TYPE _c1, _c2; \
|
|
530 r0 = x0 + y0; \
|
|
531 _c1 = r0 < x0; \
|
|
532 r1 = x1 + y1; \
|
|
533 _c2 = r1 < x1; \
|
|
534 r1 += _c1; \
|
|
535 _c2 |= r1 < _c1; \
|
|
536 r2 = x2 + y2 + _c2; \
|
|
537 } while (0)
|
|
538 #endif
|
|
539
|
|
540 #ifndef __FP_FRAC_ADD_4
|
|
541 #define __FP_FRAC_ADD_4(r3,r2,r1,r0,x3,x2,x1,x0,y3,y2,y1,y0) \
|
|
542 do { \
|
|
543 _FP_W_TYPE _c1, _c2, _c3; \
|
|
544 r0 = x0 + y0; \
|
|
545 _c1 = r0 < x0; \
|
|
546 r1 = x1 + y1; \
|
|
547 _c2 = r1 < x1; \
|
|
548 r1 += _c1; \
|
|
549 _c2 |= r1 < _c1; \
|
|
550 r2 = x2 + y2; \
|
|
551 _c3 = r2 < x2; \
|
|
552 r2 += _c2; \
|
|
553 _c3 |= r2 < _c2; \
|
|
554 r3 = x3 + y3 + _c3; \
|
|
555 } while (0)
|
|
556 #endif
|
|
557
|
|
558 #ifndef __FP_FRAC_SUB_3
|
|
559 #define __FP_FRAC_SUB_3(r2,r1,r0,x2,x1,x0,y2,y1,y0) \
|
|
560 do { \
|
|
561 _FP_W_TYPE _c1, _c2; \
|
|
562 r0 = x0 - y0; \
|
|
563 _c1 = r0 > x0; \
|
|
564 r1 = x1 - y1; \
|
|
565 _c2 = r1 > x1; \
|
|
566 r1 -= _c1; \
|
|
567 _c2 |= _c1 && (y1 == x1); \
|
|
568 r2 = x2 - y2 - _c2; \
|
|
569 } while (0)
|
|
570 #endif
|
|
571
|
|
572 #ifndef __FP_FRAC_SUB_4
|
|
573 #define __FP_FRAC_SUB_4(r3,r2,r1,r0,x3,x2,x1,x0,y3,y2,y1,y0) \
|
|
574 do { \
|
|
575 _FP_W_TYPE _c1, _c2, _c3; \
|
|
576 r0 = x0 - y0; \
|
|
577 _c1 = r0 > x0; \
|
|
578 r1 = x1 - y1; \
|
|
579 _c2 = r1 > x1; \
|
|
580 r1 -= _c1; \
|
|
581 _c2 |= _c1 && (y1 == x1); \
|
|
582 r2 = x2 - y2; \
|
|
583 _c3 = r2 > x2; \
|
|
584 r2 -= _c2; \
|
|
585 _c3 |= _c2 && (y2 == x2); \
|
|
586 r3 = x3 - y3 - _c3; \
|
|
587 } while (0)
|
|
588 #endif
|
|
589
|
|
590 #ifndef __FP_FRAC_DEC_3
|
|
591 #define __FP_FRAC_DEC_3(x2,x1,x0,y2,y1,y0) \
|
|
592 do { \
|
|
593 UWtype _t0, _t1, _t2; \
|
|
594 _t0 = x0, _t1 = x1, _t2 = x2; \
|
|
595 __FP_FRAC_SUB_3 (x2, x1, x0, _t2, _t1, _t0, y2, y1, y0); \
|
|
596 } while (0)
|
|
597 #endif
|
|
598
|
|
599 #ifndef __FP_FRAC_DEC_4
|
|
600 #define __FP_FRAC_DEC_4(x3,x2,x1,x0,y3,y2,y1,y0) \
|
|
601 do { \
|
|
602 UWtype _t0, _t1, _t2, _t3; \
|
|
603 _t0 = x0, _t1 = x1, _t2 = x2, _t3 = x3; \
|
|
604 __FP_FRAC_SUB_4 (x3,x2,x1,x0,_t3,_t2,_t1,_t0, y3,y2,y1,y0); \
|
|
605 } while (0)
|
|
606 #endif
|
|
607
|
|
608 #ifndef __FP_FRAC_ADDI_4
|
|
609 #define __FP_FRAC_ADDI_4(x3,x2,x1,x0,i) \
|
|
610 do { \
|
|
611 UWtype _t; \
|
|
612 _t = ((x0 += i) < i); \
|
|
613 x1 += _t; _t = (x1 < _t); \
|
|
614 x2 += _t; _t = (x2 < _t); \
|
|
615 x3 += _t; \
|
|
616 } while (0)
|
|
617 #endif
|
|
618
|
|
619 /* Convert FP values between word sizes. This appears to be more
|
|
620 * complicated than I'd have expected it to be, so these might be
|
|
621 * wrong... These macros are in any case somewhat bogus because they
|
|
622 * use information about what various FRAC_n variables look like
|
|
623 * internally [eg, that 2 word vars are X_f0 and x_f1]. But so do
|
|
624 * the ones in op-2.h and op-1.h.
|
|
625 */
|
|
626 #define _FP_FRAC_COPY_1_4(D, S) (D##_f = S##_f[0])
|
|
627
|
|
628 #define _FP_FRAC_COPY_2_4(D, S) \
|
|
629 do { \
|
|
630 D##_f0 = S##_f[0]; \
|
|
631 D##_f1 = S##_f[1]; \
|
|
632 } while (0)
|
|
633
|
|
634 /* Assembly/disassembly for converting to/from integral types.
|
|
635 * No shifting or overflow handled here.
|
|
636 */
|
|
637 /* Put the FP value X into r, which is an integer of size rsize. */
|
|
638 #define _FP_FRAC_ASSEMBLE_4(r, X, rsize) \
|
|
639 do { \
|
|
640 if (rsize <= _FP_W_TYPE_SIZE) \
|
|
641 r = X##_f[0]; \
|
|
642 else if (rsize <= 2*_FP_W_TYPE_SIZE) \
|
|
643 { \
|
|
644 r = X##_f[1]; \
|
|
645 r <<= _FP_W_TYPE_SIZE; \
|
|
646 r += X##_f[0]; \
|
|
647 } \
|
|
648 else \
|
|
649 { \
|
|
650 /* I'm feeling lazy so we deal with int == 3words (implausible)*/ \
|
|
651 /* and int == 4words as a single case. */ \
|
|
652 r = X##_f[3]; \
|
|
653 r <<= _FP_W_TYPE_SIZE; \
|
|
654 r += X##_f[2]; \
|
|
655 r <<= _FP_W_TYPE_SIZE; \
|
|
656 r += X##_f[1]; \
|
|
657 r <<= _FP_W_TYPE_SIZE; \
|
|
658 r += X##_f[0]; \
|
|
659 } \
|
|
660 } while (0)
|
|
661
|
|
662 /* "No disassemble Number Five!" */
|
|
663 /* move an integer of size rsize into X's fractional part. We rely on
|
|
664 * the _f[] array consisting of words of size _FP_W_TYPE_SIZE to avoid
|
|
665 * having to mask the values we store into it.
|
|
666 */
|
|
667 #define _FP_FRAC_DISASSEMBLE_4(X, r, rsize) \
|
|
668 do { \
|
|
669 X##_f[0] = r; \
|
|
670 X##_f[1] = (rsize <= _FP_W_TYPE_SIZE ? 0 : r >> _FP_W_TYPE_SIZE); \
|
|
671 X##_f[2] = (rsize <= 2*_FP_W_TYPE_SIZE ? 0 : r >> 2*_FP_W_TYPE_SIZE); \
|
|
672 X##_f[3] = (rsize <= 3*_FP_W_TYPE_SIZE ? 0 : r >> 3*_FP_W_TYPE_SIZE); \
|
|
673 } while (0);
|
|
674
|
|
675 #define _FP_FRAC_COPY_4_1(D, S) \
|
|
676 do { \
|
|
677 D##_f[0] = S##_f; \
|
|
678 D##_f[1] = D##_f[2] = D##_f[3] = 0; \
|
|
679 } while (0)
|
|
680
|
|
681 #define _FP_FRAC_COPY_4_2(D, S) \
|
|
682 do { \
|
|
683 D##_f[0] = S##_f0; \
|
|
684 D##_f[1] = S##_f1; \
|
|
685 D##_f[2] = D##_f[3] = 0; \
|
|
686 } while (0)
|
|
687
|
|
688 #define _FP_FRAC_COPY_4_4(D,S) _FP_FRAC_COPY_4(D,S)
|