manual update from upstream:
[linux-2.6] / arch / mips / math-emu / sp_add.c
1 /* IEEE754 floating point arithmetic
2  * single precision
3  */
4 /*
5  * MIPS floating point support
6  * Copyright (C) 1994-2000 Algorithmics Ltd.
7  * http://www.algor.co.uk
8  *
9  * ########################################################################
10  *
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.
14  *
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.
19  *
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.
23  *
24  * ########################################################################
25  */
26
27
28 #include "ieee754sp.h"
29
30 ieee754sp ieee754sp_add(ieee754sp x, ieee754sp y)
31 {
32         COMPXSP;
33         COMPYSP;
34
35         EXPLODEXSP;
36         EXPLODEYSP;
37
38         CLEARCX;
39
40         FLUSHXSP;
41         FLUSHYSP;
42
43         switch (CLPAIR(xc, yc)) {
44         case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_QNAN):
45         case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_SNAN):
46         case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_SNAN):
47         case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_SNAN):
48         case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_SNAN):
49         case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_SNAN):
50         case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_SNAN):
51         case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_ZERO):
52         case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_NORM):
53         case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_DNORM):
54         case CLPAIR(IEEE754_CLASS_SNAN, IEEE754_CLASS_INF):
55                 SETCX(IEEE754_INVALID_OPERATION);
56                 return ieee754sp_nanxcpt(ieee754sp_indef(), "add", x, y);
57
58         case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_QNAN):
59         case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_QNAN):
60         case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_QNAN):
61         case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_QNAN):
62                 return y;
63
64         case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_QNAN):
65         case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_ZERO):
66         case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_NORM):
67         case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_DNORM):
68         case CLPAIR(IEEE754_CLASS_QNAN, IEEE754_CLASS_INF):
69                 return x;
70
71
72                 /* Infinity handling
73                  */
74
75         case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_INF):
76                 if (xs == ys)
77                         return x;
78                 SETCX(IEEE754_INVALID_OPERATION);
79                 return ieee754sp_xcpt(ieee754sp_indef(), "add", x, y);
80
81         case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_INF):
82         case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_INF):
83         case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_INF):
84                 return y;
85
86         case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_ZERO):
87         case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_NORM):
88         case CLPAIR(IEEE754_CLASS_INF, IEEE754_CLASS_DNORM):
89                 return x;
90
91                 /* Zero handling
92                  */
93
94         case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_ZERO):
95                 if (xs == ys)
96                         return x;
97                 else
98                         return ieee754sp_zero(ieee754_csr.rm ==
99                                               IEEE754_RD);
100
101         case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_ZERO):
102         case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_ZERO):
103                 return x;
104
105         case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_NORM):
106         case CLPAIR(IEEE754_CLASS_ZERO, IEEE754_CLASS_DNORM):
107                 return y;
108
109         case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_DNORM):
110                 SPDNORMX;
111
112         case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_DNORM):
113                 SPDNORMY;
114                 break;
115
116         case CLPAIR(IEEE754_CLASS_DNORM, IEEE754_CLASS_NORM):
117                 SPDNORMX;
118                 break;
119
120         case CLPAIR(IEEE754_CLASS_NORM, IEEE754_CLASS_NORM):
121                 break;
122         }
123         assert(xm & SP_HIDDEN_BIT);
124         assert(ym & SP_HIDDEN_BIT);
125
126         /* provide guard,round and stick bit space */
127         xm <<= 3;
128         ym <<= 3;
129
130         if (xe > ye) {
131                 /* have to shift y fraction right to align
132                  */
133                 int s = xe - ye;
134                 SPXSRSYn(s);
135         } else if (ye > xe) {
136                 /* have to shift x fraction right to align
137                  */
138                 int s = ye - xe;
139                 SPXSRSXn(s);
140         }
141         assert(xe == ye);
142         assert(xe <= SP_EMAX);
143
144         if (xs == ys) {
145                 /* generate 28 bit result of adding two 27 bit numbers
146                  * leaving result in xm,xs,xe
147                  */
148                 xm = xm + ym;
149                 xe = xe;
150                 xs = xs;
151
152                 if (xm >> (SP_MBITS + 1 + 3)) { /* carry out */
153                         SPXSRSX1();
154                 }
155         } else {
156                 if (xm >= ym) {
157                         xm = xm - ym;
158                         xe = xe;
159                         xs = xs;
160                 } else {
161                         xm = ym - xm;
162                         xe = xe;
163                         xs = ys;
164                 }
165                 if (xm == 0)
166                         return ieee754sp_zero(ieee754_csr.rm ==
167                                               IEEE754_RD);
168
169                 /* normalize in extended single precision */
170                 while ((xm >> (SP_MBITS + 3)) == 0) {
171                         xm <<= 1;
172                         xe--;
173                 }
174
175         }
176         SPNORMRET2(xs, xe, xm, "add", x, y);
177 }