Blackfin arch: flush/inv the correct range when using write back cache and fix bugs...
[linux-2.6] / arch / parisc / math-emu / sfsub.c
1 /*
2  * Linux/PA-RISC Project (http://www.parisc-linux.org/)
3  *
4  * Floating-point emulation code
5  *  Copyright (C) 2001 Hewlett-Packard (Paul Bame) <bame@debian.org>
6  *
7  *    This program is free software; you can redistribute it and/or modify
8  *    it under the terms of the GNU General Public License as published by
9  *    the Free Software Foundation; either version 2, or (at your option)
10  *    any later version.
11  *
12  *    This program is distributed in the hope that it will be useful,
13  *    but WITHOUT ANY WARRANTY; without even the implied warranty of
14  *    MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the
15  *    GNU General Public License for more details.
16  *
17  *    You should have received a copy of the GNU General Public License
18  *    along with this program; if not, write to the Free Software
19  *    Foundation, Inc., 59 Temple Place, Suite 330, Boston, MA  02111-1307  USA
20  */
21 /*
22  * BEGIN_DESC
23  *
24  *  File:
25  *      @(#)    pa/spmath/sfsub.c               $Revision: 1.1 $
26  *
27  *  Purpose:
28  *      Single_subtract: subtract two single precision values.
29  *
30  *  External Interfaces:
31  *      sgl_fsub(leftptr, rightptr, dstptr, status)
32  *
33  *  Internal Interfaces:
34  *
35  *  Theory:
36  *      <<please update with a overview of the operation of this file>>
37  *
38  * END_DESC
39 */
40
41
42 #include "float.h"
43 #include "sgl_float.h"
44
45 /*
46  * Single_subtract: subtract two single precision values.
47  */
48 int
49 sgl_fsub(
50             sgl_floating_point *leftptr,
51             sgl_floating_point *rightptr,
52             sgl_floating_point *dstptr,
53             unsigned int *status)
54     {
55     register unsigned int left, right, result, extent;
56     register unsigned int signless_upper_left, signless_upper_right, save;
57     
58     register int result_exponent, right_exponent, diff_exponent;
59     register int sign_save, jumpsize;
60     register boolean inexact = FALSE, underflowtrap;
61         
62     /* Create local copies of the numbers */
63     left = *leftptr;
64     right = *rightptr;
65
66     /* A zero "save" helps discover equal operands (for later),  *
67      * and is used in swapping operands (if needed).             */
68     Sgl_xortointp1(left,right,/*to*/save);
69
70     /*
71      * check first operand for NaN's or infinity
72      */
73     if ((result_exponent = Sgl_exponent(left)) == SGL_INFINITY_EXPONENT)
74         {
75         if (Sgl_iszero_mantissa(left)) 
76             {
77             if (Sgl_isnotnan(right)) 
78                 {
79                 if (Sgl_isinfinity(right) && save==0) 
80                     {
81                     /* 
82                      * invalid since operands are same signed infinity's
83                      */
84                     if (Is_invalidtrap_enabled()) return(INVALIDEXCEPTION);
85                     Set_invalidflag();
86                     Sgl_makequietnan(result);
87                     *dstptr = result;
88                     return(NOEXCEPTION);
89                     }
90                 /*
91                  * return infinity
92                  */
93                 *dstptr = left;
94                 return(NOEXCEPTION);
95                 }
96             }
97         else 
98             {
99             /*
100              * is NaN; signaling or quiet?
101              */
102             if (Sgl_isone_signaling(left)) 
103                 {
104                 /* trap if INVALIDTRAP enabled */
105                 if (Is_invalidtrap_enabled()) return(INVALIDEXCEPTION);
106                 /* make NaN quiet */
107                 Set_invalidflag();
108                 Sgl_set_quiet(left);
109                 }
110             /* 
111              * is second operand a signaling NaN? 
112              */
113             else if (Sgl_is_signalingnan(right)) 
114                 {
115                 /* trap if INVALIDTRAP enabled */
116                 if (Is_invalidtrap_enabled()) return(INVALIDEXCEPTION);
117                 /* make NaN quiet */
118                 Set_invalidflag();
119                 Sgl_set_quiet(right);
120                 *dstptr = right;
121                 return(NOEXCEPTION);
122                 }
123             /*
124              * return quiet NaN
125              */
126             *dstptr = left;
127             return(NOEXCEPTION);
128             }
129         } /* End left NaN or Infinity processing */
130     /*
131      * check second operand for NaN's or infinity
132      */
133     if (Sgl_isinfinity_exponent(right)) 
134         {
135         if (Sgl_iszero_mantissa(right)) 
136             {
137             /* return infinity */
138             Sgl_invert_sign(right);
139             *dstptr = right;
140             return(NOEXCEPTION);
141             }
142         /*
143          * is NaN; signaling or quiet?
144          */
145         if (Sgl_isone_signaling(right)) 
146             {
147             /* trap if INVALIDTRAP enabled */
148             if (Is_invalidtrap_enabled()) return(INVALIDEXCEPTION);
149             /* make NaN quiet */
150             Set_invalidflag();
151             Sgl_set_quiet(right);
152             }
153         /*
154          * return quiet NaN
155          */
156         *dstptr = right;
157         return(NOEXCEPTION);
158         } /* End right NaN or Infinity processing */
159
160     /* Invariant: Must be dealing with finite numbers */
161
162     /* Compare operands by removing the sign */
163     Sgl_copytoint_exponentmantissa(left,signless_upper_left);
164     Sgl_copytoint_exponentmantissa(right,signless_upper_right);
165
166     /* sign difference selects sub or add operation. */
167     if(Sgl_ismagnitudeless(signless_upper_left,signless_upper_right))
168         {
169         /* Set the left operand to the larger one by XOR swap *
170          *  First finish the first word using "save"          */
171         Sgl_xorfromintp1(save,right,/*to*/right);
172         Sgl_xorfromintp1(save,left,/*to*/left);
173         result_exponent = Sgl_exponent(left);
174         Sgl_invert_sign(left);
175         }
176     /* Invariant:  left is not smaller than right. */ 
177
178     if((right_exponent = Sgl_exponent(right)) == 0)
179         {
180         /* Denormalized operands.  First look for zeroes */
181         if(Sgl_iszero_mantissa(right)) 
182             {
183             /* right is zero */
184             if(Sgl_iszero_exponentmantissa(left))
185                 {
186                 /* Both operands are zeros */
187                 Sgl_invert_sign(right);
188                 if(Is_rounding_mode(ROUNDMINUS))
189                     {
190                     Sgl_or_signs(left,/*with*/right);
191                     }
192                 else
193                     {
194                     Sgl_and_signs(left,/*with*/right);
195                     }
196                 }
197             else 
198                 {
199                 /* Left is not a zero and must be the result.  Trapped
200                  * underflows are signaled if left is denormalized.  Result
201                  * is always exact. */
202                 if( (result_exponent == 0) && Is_underflowtrap_enabled() )
203                     {
204                     /* need to normalize results mantissa */
205                     sign_save = Sgl_signextendedsign(left);
206                     Sgl_leftshiftby1(left);
207                     Sgl_normalize(left,result_exponent);
208                     Sgl_set_sign(left,/*using*/sign_save);
209                     Sgl_setwrapped_exponent(left,result_exponent,unfl);
210                     *dstptr = left;
211                     /* inexact = FALSE */
212                     return(UNDERFLOWEXCEPTION);
213                     }
214                 }
215             *dstptr = left;
216             return(NOEXCEPTION);
217             }
218
219         /* Neither are zeroes */
220         Sgl_clear_sign(right);  /* Exponent is already cleared */
221         if(result_exponent == 0 )
222             {
223             /* Both operands are denormalized.  The result must be exact
224              * and is simply calculated.  A sum could become normalized and a
225              * difference could cancel to a true zero. */
226             if( (/*signed*/int) save >= 0 )
227                 {
228                 Sgl_subtract(left,/*minus*/right,/*into*/result);
229                 if(Sgl_iszero_mantissa(result))
230                     {
231                     if(Is_rounding_mode(ROUNDMINUS))
232                         {
233                         Sgl_setone_sign(result);
234                         }
235                     else
236                         {
237                         Sgl_setzero_sign(result);
238                         }
239                     *dstptr = result;
240                     return(NOEXCEPTION);
241                     }
242                 }
243             else
244                 {
245                 Sgl_addition(left,right,/*into*/result);
246                 if(Sgl_isone_hidden(result))
247                     {
248                     *dstptr = result;
249                     return(NOEXCEPTION);
250                     }
251                 }
252             if(Is_underflowtrap_enabled())
253                 {
254                 /* need to normalize result */
255                 sign_save = Sgl_signextendedsign(result);
256                 Sgl_leftshiftby1(result);
257                 Sgl_normalize(result,result_exponent);
258                 Sgl_set_sign(result,/*using*/sign_save);
259                 Sgl_setwrapped_exponent(result,result_exponent,unfl);
260                 *dstptr = result;
261                 /* inexact = FALSE */
262                 return(UNDERFLOWEXCEPTION);
263                 }
264             *dstptr = result;
265             return(NOEXCEPTION);
266             }
267         right_exponent = 1;     /* Set exponent to reflect different bias
268                                  * with denomalized numbers. */
269         }
270     else
271         {
272         Sgl_clear_signexponent_set_hidden(right);
273         }
274     Sgl_clear_exponent_set_hidden(left);
275     diff_exponent = result_exponent - right_exponent;
276
277     /* 
278      * Special case alignment of operands that would force alignment 
279      * beyond the extent of the extension.  A further optimization
280      * could special case this but only reduces the path length for this
281      * infrequent case.
282      */
283     if(diff_exponent > SGL_THRESHOLD)
284         {
285         diff_exponent = SGL_THRESHOLD;
286         }
287     
288     /* Align right operand by shifting to right */
289     Sgl_right_align(/*operand*/right,/*shifted by*/diff_exponent,
290       /*and lower to*/extent);
291
292     /* Treat sum and difference of the operands separately. */
293     if( (/*signed*/int) save >= 0 )
294         {
295         /*
296          * Difference of the two operands.  Their can be no overflow.  A
297          * borrow can occur out of the hidden bit and force a post
298          * normalization phase.
299          */
300         Sgl_subtract_withextension(left,/*minus*/right,/*with*/extent,/*into*/result);
301         if(Sgl_iszero_hidden(result))
302             {
303             /* Handle normalization */
304             /* A straight foward algorithm would now shift the result
305              * and extension left until the hidden bit becomes one.  Not
306              * all of the extension bits need participate in the shift.
307              * Only the two most significant bits (round and guard) are
308              * needed.  If only a single shift is needed then the guard
309              * bit becomes a significant low order bit and the extension
310              * must participate in the rounding.  If more than a single 
311              * shift is needed, then all bits to the right of the guard 
312              * bit are zeros, and the guard bit may or may not be zero. */
313             sign_save = Sgl_signextendedsign(result);
314             Sgl_leftshiftby1_withextent(result,extent,result);
315
316             /* Need to check for a zero result.  The sign and exponent
317              * fields have already been zeroed.  The more efficient test
318              * of the full object can be used.
319              */
320             if(Sgl_iszero(result))
321                 /* Must have been "x-x" or "x+(-x)". */
322                 {
323                 if(Is_rounding_mode(ROUNDMINUS)) Sgl_setone_sign(result);
324                 *dstptr = result;
325                 return(NOEXCEPTION);
326                 }
327             result_exponent--;
328             /* Look to see if normalization is finished. */
329             if(Sgl_isone_hidden(result))
330                 {
331                 if(result_exponent==0)
332                     {
333                     /* Denormalized, exponent should be zero.  Left operand *
334                      * was normalized, so extent (guard, round) was zero    */
335                     goto underflow;
336                     }
337                 else
338                     {
339                     /* No further normalization is needed. */
340                     Sgl_set_sign(result,/*using*/sign_save);
341                     Ext_leftshiftby1(extent);
342                     goto round;
343                     }
344                 }
345
346             /* Check for denormalized, exponent should be zero.  Left    *
347              * operand was normalized, so extent (guard, round) was zero */
348             if(!(underflowtrap = Is_underflowtrap_enabled()) &&
349                result_exponent==0) goto underflow;
350
351             /* Shift extension to complete one bit of normalization and
352              * update exponent. */
353             Ext_leftshiftby1(extent);
354
355             /* Discover first one bit to determine shift amount.  Use a
356              * modified binary search.  We have already shifted the result
357              * one position right and still not found a one so the remainder
358              * of the extension must be zero and simplifies rounding. */
359             /* Scan bytes */
360             while(Sgl_iszero_hiddenhigh7mantissa(result))
361                 {
362                 Sgl_leftshiftby8(result);
363                 if((result_exponent -= 8) <= 0  && !underflowtrap)
364                     goto underflow;
365                 }
366             /* Now narrow it down to the nibble */
367             if(Sgl_iszero_hiddenhigh3mantissa(result))
368                 {
369                 /* The lower nibble contains the normalizing one */
370                 Sgl_leftshiftby4(result);
371                 if((result_exponent -= 4) <= 0 && !underflowtrap)
372                     goto underflow;
373                 }
374             /* Select case were first bit is set (already normalized)
375              * otherwise select the proper shift. */
376             if((jumpsize = Sgl_hiddenhigh3mantissa(result)) > 7)
377                 {
378                 /* Already normalized */
379                 if(result_exponent <= 0) goto underflow;
380                 Sgl_set_sign(result,/*using*/sign_save);
381                 Sgl_set_exponent(result,/*using*/result_exponent);
382                 *dstptr = result;
383                 return(NOEXCEPTION);
384                 }
385             Sgl_sethigh4bits(result,/*using*/sign_save);
386             switch(jumpsize) 
387                 {
388                 case 1:
389                     {
390                     Sgl_leftshiftby3(result);
391                     result_exponent -= 3;
392                     break;
393                     }
394                 case 2:
395                 case 3:
396                     {
397                     Sgl_leftshiftby2(result);
398                     result_exponent -= 2;
399                     break;
400                     }
401                 case 4:
402                 case 5:
403                 case 6:
404                 case 7:
405                     {
406                     Sgl_leftshiftby1(result);
407                     result_exponent -= 1;
408                     break;
409                     }
410                 }
411             if(result_exponent > 0) 
412                 {
413                 Sgl_set_exponent(result,/*using*/result_exponent);
414                 *dstptr = result;       /* Sign bit is already set */
415                 return(NOEXCEPTION);
416                 }
417             /* Fixup potential underflows */
418           underflow:
419             if(Is_underflowtrap_enabled())
420                 {
421                 Sgl_set_sign(result,sign_save);
422                 Sgl_setwrapped_exponent(result,result_exponent,unfl);
423                 *dstptr = result;
424                 /* inexact = FALSE */
425                 return(UNDERFLOWEXCEPTION);
426                 }
427             /*
428              * Since we cannot get an inexact denormalized result,
429              * we can now return.
430              */
431             Sgl_right_align(result,/*by*/(1-result_exponent),extent);
432             Sgl_clear_signexponent(result);
433             Sgl_set_sign(result,sign_save);
434             *dstptr = result;
435             return(NOEXCEPTION);
436             } /* end if(hidden...)... */
437         /* Fall through and round */
438         } /* end if(save >= 0)... */
439     else 
440         {
441         /* Add magnitudes */
442         Sgl_addition(left,right,/*to*/result);
443         if(Sgl_isone_hiddenoverflow(result))
444             {
445             /* Prenormalization required. */
446             Sgl_rightshiftby1_withextent(result,extent,extent);
447             Sgl_arithrightshiftby1(result);
448             result_exponent++;
449             } /* end if hiddenoverflow... */
450         } /* end else ...sub magnitudes... */
451     
452     /* Round the result.  If the extension is all zeros,then the result is
453      * exact.  Otherwise round in the correct direction.  No underflow is
454      * possible. If a postnormalization is necessary, then the mantissa is
455      * all zeros so no shift is needed. */
456   round:
457     if(Ext_isnotzero(extent))
458         {
459         inexact = TRUE;
460         switch(Rounding_mode())
461             {
462             case ROUNDNEAREST: /* The default. */
463             if(Ext_isone_sign(extent))
464                 {
465                 /* at least 1/2 ulp */
466                 if(Ext_isnotzero_lower(extent)  ||
467                   Sgl_isone_lowmantissa(result))
468                     {
469                     /* either exactly half way and odd or more than 1/2ulp */
470                     Sgl_increment(result);
471                     }
472                 }
473             break;
474
475             case ROUNDPLUS:
476             if(Sgl_iszero_sign(result))
477                 {
478                 /* Round up positive results */
479                 Sgl_increment(result);
480                 }
481             break;
482             
483             case ROUNDMINUS:
484             if(Sgl_isone_sign(result))
485                 {
486                 /* Round down negative results */
487                 Sgl_increment(result);
488                 }
489             
490             case ROUNDZERO:;
491             /* truncate is simple */
492             } /* end switch... */
493         if(Sgl_isone_hiddenoverflow(result)) result_exponent++;
494         }
495     if(result_exponent == SGL_INFINITY_EXPONENT)
496         {
497         /* Overflow */
498         if(Is_overflowtrap_enabled())
499             {
500             Sgl_setwrapped_exponent(result,result_exponent,ovfl);
501             *dstptr = result;
502             if (inexact)
503                 if (Is_inexacttrap_enabled())
504                     return(OVERFLOWEXCEPTION | INEXACTEXCEPTION);
505                 else Set_inexactflag();
506             return(OVERFLOWEXCEPTION);
507             }
508         else
509             {
510             Set_overflowflag();
511             inexact = TRUE;
512             Sgl_setoverflow(result);
513             }
514         }
515     else Sgl_set_exponent(result,result_exponent);
516     *dstptr = result;
517     if(inexact) 
518         if(Is_inexacttrap_enabled()) return(INEXACTEXCEPTION);
519         else Set_inexactflag();
520     return(NOEXCEPTION);
521     }