mm: fix XIP file writes
[wrt350n-kernel.git] / arch / mips / math-emu / ieee754dp.c
blob6d2d89f324721115a6577d8726f1f38404d08c9d
1 /* IEEE754 floating point arithmetic
2 * double precision: common utilities
3 */
4 /*
5 * MIPS floating point support
6 * Copyright (C) 1994-2000 Algorithmics Ltd.
7 * http://www.algor.co.uk
9 * ########################################################################
11 * This program is free software; you can distribute it and/or modify it
12 * under the terms of the GNU General Public License (Version 2) as
13 * published by the Free Software Foundation.
15 * This program is distributed in the hope it will be useful, but WITHOUT
16 * ANY WARRANTY; without even the implied warranty of MERCHANTABILITY or
17 * FITNESS FOR A PARTICULAR PURPOSE. See the GNU General Public License
18 * for more details.
20 * You should have received a copy of the GNU General Public License along
21 * with this program; if not, write to the Free Software Foundation, Inc.,
22 * 59 Temple Place - Suite 330, Boston MA 02111-1307, USA.
24 * ########################################################################
28 #include "ieee754dp.h"
30 int ieee754dp_class(ieee754dp x)
32 COMPXDP;
33 EXPLODEXDP;
34 return xc;
37 int ieee754dp_isnan(ieee754dp x)
39 return ieee754dp_class(x) >= IEEE754_CLASS_SNAN;
42 int ieee754dp_issnan(ieee754dp x)
44 assert(ieee754dp_isnan(x));
45 return ((DPMANT(x) & DP_MBIT(DP_MBITS-1)) == DP_MBIT(DP_MBITS-1));
49 ieee754dp ieee754dp_xcpt(ieee754dp r, const char *op, ...)
51 struct ieee754xctx ax;
52 if (!TSTX())
53 return r;
55 ax.op = op;
56 ax.rt = IEEE754_RT_DP;
57 ax.rv.dp = r;
58 va_start(ax.ap, op);
59 ieee754_xcpt(&ax);
60 va_end(ax.ap);
61 return ax.rv.dp;
64 ieee754dp ieee754dp_nanxcpt(ieee754dp r, const char *op, ...)
66 struct ieee754xctx ax;
68 assert(ieee754dp_isnan(r));
70 if (!ieee754dp_issnan(r)) /* QNAN does not cause invalid op !! */
71 return r;
73 if (!SETANDTESTCX(IEEE754_INVALID_OPERATION)) {
74 /* not enabled convert to a quiet NaN */
75 DPMANT(r) &= (~DP_MBIT(DP_MBITS-1));
76 if (ieee754dp_isnan(r))
77 return r;
78 else
79 return ieee754dp_indef();
82 ax.op = op;
83 ax.rt = 0;
84 ax.rv.dp = r;
85 va_start(ax.ap, op);
86 ieee754_xcpt(&ax);
87 va_end(ax.ap);
88 return ax.rv.dp;
91 ieee754dp ieee754dp_bestnan(ieee754dp x, ieee754dp y)
93 assert(ieee754dp_isnan(x));
94 assert(ieee754dp_isnan(y));
96 if (DPMANT(x) > DPMANT(y))
97 return x;
98 else
99 return y;
103 static u64 get_rounding(int sn, u64 xm)
105 /* inexact must round of 3 bits
107 if (xm & (DP_MBIT(3) - 1)) {
108 switch (ieee754_csr.rm) {
109 case IEEE754_RZ:
110 break;
111 case IEEE754_RN:
112 xm += 0x3 + ((xm >> 3) & 1);
113 /* xm += (xm&0x8)?0x4:0x3 */
114 break;
115 case IEEE754_RU: /* toward +Infinity */
116 if (!sn) /* ?? */
117 xm += 0x8;
118 break;
119 case IEEE754_RD: /* toward -Infinity */
120 if (sn) /* ?? */
121 xm += 0x8;
122 break;
125 return xm;
129 /* generate a normal/denormal number with over,under handling
130 * sn is sign
131 * xe is an unbiased exponent
132 * xm is 3bit extended precision value.
134 ieee754dp ieee754dp_format(int sn, int xe, u64 xm)
136 assert(xm); /* we don't gen exact zeros (probably should) */
138 assert((xm >> (DP_MBITS + 1 + 3)) == 0); /* no execess */
139 assert(xm & (DP_HIDDEN_BIT << 3));
141 if (xe < DP_EMIN) {
142 /* strip lower bits */
143 int es = DP_EMIN - xe;
145 if (ieee754_csr.nod) {
146 SETCX(IEEE754_UNDERFLOW);
147 SETCX(IEEE754_INEXACT);
149 switch(ieee754_csr.rm) {
150 case IEEE754_RN:
151 return ieee754dp_zero(sn);
152 case IEEE754_RZ:
153 return ieee754dp_zero(sn);
154 case IEEE754_RU: /* toward +Infinity */
155 if(sn == 0)
156 return ieee754dp_min(0);
157 else
158 return ieee754dp_zero(1);
159 case IEEE754_RD: /* toward -Infinity */
160 if(sn == 0)
161 return ieee754dp_zero(0);
162 else
163 return ieee754dp_min(1);
167 if (xe == DP_EMIN - 1
168 && get_rounding(sn, xm) >> (DP_MBITS + 1 + 3))
170 /* Not tiny after rounding */
171 SETCX(IEEE754_INEXACT);
172 xm = get_rounding(sn, xm);
173 xm >>= 1;
174 /* Clear grs bits */
175 xm &= ~(DP_MBIT(3) - 1);
176 xe++;
178 else {
179 /* sticky right shift es bits
181 xm = XDPSRS(xm, es);
182 xe += es;
183 assert((xm & (DP_HIDDEN_BIT << 3)) == 0);
184 assert(xe == DP_EMIN);
187 if (xm & (DP_MBIT(3) - 1)) {
188 SETCX(IEEE754_INEXACT);
189 if ((xm & (DP_HIDDEN_BIT << 3)) == 0) {
190 SETCX(IEEE754_UNDERFLOW);
193 /* inexact must round of 3 bits
195 xm = get_rounding(sn, xm);
196 /* adjust exponent for rounding add overflowing
198 if (xm >> (DP_MBITS + 3 + 1)) {
199 /* add causes mantissa overflow */
200 xm >>= 1;
201 xe++;
204 /* strip grs bits */
205 xm >>= 3;
207 assert((xm >> (DP_MBITS + 1)) == 0); /* no execess */
208 assert(xe >= DP_EMIN);
210 if (xe > DP_EMAX) {
211 SETCX(IEEE754_OVERFLOW);
212 SETCX(IEEE754_INEXACT);
213 /* -O can be table indexed by (rm,sn) */
214 switch (ieee754_csr.rm) {
215 case IEEE754_RN:
216 return ieee754dp_inf(sn);
217 case IEEE754_RZ:
218 return ieee754dp_max(sn);
219 case IEEE754_RU: /* toward +Infinity */
220 if (sn == 0)
221 return ieee754dp_inf(0);
222 else
223 return ieee754dp_max(1);
224 case IEEE754_RD: /* toward -Infinity */
225 if (sn == 0)
226 return ieee754dp_max(0);
227 else
228 return ieee754dp_inf(1);
231 /* gen norm/denorm/zero */
233 if ((xm & DP_HIDDEN_BIT) == 0) {
234 /* we underflow (tiny/zero) */
235 assert(xe == DP_EMIN);
236 if (ieee754_csr.mx & IEEE754_UNDERFLOW)
237 SETCX(IEEE754_UNDERFLOW);
238 return builddp(sn, DP_EMIN - 1 + DP_EBIAS, xm);
239 } else {
240 assert((xm >> (DP_MBITS + 1)) == 0); /* no execess */
241 assert(xm & DP_HIDDEN_BIT);
243 return builddp(sn, xe + DP_EBIAS, xm & ~DP_HIDDEN_BIT);