OpenCores
URL https://opencores.org/ocsvn/openrisc/openrisc/trunk

Subversion Repositories openrisc

[/] [openrisc/] [trunk/] [gnu-dev/] [or1k-gcc/] [libgcc/] [soft-fp/] [op-4.h] - Blame information for rev 841

Go to most recent revision | Details | Compare with Previous | View Log

Line No. Rev Author Line
1 734 jeremybenn
/* 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)

powered by: WebSVN 2.1.0

© copyright 1999-2024 OpenCores.org, equivalent to Oliscience, all rights reserved. OpenCores®, registered trademark.