Merge branch 'for-greg' of git://gitorious.org/usb/usb into usb-linus
[pandora-kernel.git] / arch / parisc / math-emu / dfsub.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/dfsub.c               $Revision: 1.1 $
26  *
27  *  Purpose:
28  *      Double_subtract: subtract two double precision values.
29  *
30  *  External Interfaces:
31  *      dbl_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 "dbl_float.h"
44
45 /*
46  * Double_subtract: subtract two double precision values.
47  */
48 int
49 dbl_fsub(
50             dbl_floating_point *leftptr,
51             dbl_floating_point *rightptr,
52             dbl_floating_point *dstptr,
53             unsigned int *status)
54     {
55     register unsigned int signless_upper_left, signless_upper_right, save;
56     register unsigned int leftp1, leftp2, rightp1, rightp2, extent;
57     register unsigned int resultp1 = 0, resultp2 = 0;
58     
59     register int result_exponent, right_exponent, diff_exponent;
60     register int sign_save, jumpsize;
61     register boolean inexact = FALSE, underflowtrap;
62         
63     /* Create local copies of the numbers */
64     Dbl_copyfromptr(leftptr,leftp1,leftp2);
65     Dbl_copyfromptr(rightptr,rightp1,rightp2);
66
67     /* A zero "save" helps discover equal operands (for later),  *
68      * and is used in swapping operands (if needed).             */
69     Dbl_xortointp1(leftp1,rightp1,/*to*/save);
70
71     /*
72      * check first operand for NaN's or infinity
73      */
74     if ((result_exponent = Dbl_exponent(leftp1)) == DBL_INFINITY_EXPONENT)
75         {
76         if (Dbl_iszero_mantissa(leftp1,leftp2)) 
77             {
78             if (Dbl_isnotnan(rightp1,rightp2)) 
79                 {
80                 if (Dbl_isinfinity(rightp1,rightp2) && save==0) 
81                     {
82                     /* 
83                      * invalid since operands are same signed infinity's
84                      */
85                     if (Is_invalidtrap_enabled()) return(INVALIDEXCEPTION);
86                     Set_invalidflag();
87                     Dbl_makequietnan(resultp1,resultp2);
88                     Dbl_copytoptr(resultp1,resultp2,dstptr);
89                     return(NOEXCEPTION);
90                     }
91                 /*
92                  * return infinity
93                  */
94                 Dbl_copytoptr(leftp1,leftp2,dstptr);
95                 return(NOEXCEPTION);
96                 }
97             }
98         else 
99             {
100             /*
101              * is NaN; signaling or quiet?
102              */
103             if (Dbl_isone_signaling(leftp1)) 
104                 {
105                 /* trap if INVALIDTRAP enabled */
106                 if (Is_invalidtrap_enabled()) return(INVALIDEXCEPTION);
107                 /* make NaN quiet */
108                 Set_invalidflag();
109                 Dbl_set_quiet(leftp1);
110                 }
111             /* 
112              * is second operand a signaling NaN? 
113              */
114             else if (Dbl_is_signalingnan(rightp1)) 
115                 {
116                 /* trap if INVALIDTRAP enabled */
117                 if (Is_invalidtrap_enabled()) return(INVALIDEXCEPTION);
118                 /* make NaN quiet */
119                 Set_invalidflag();
120                 Dbl_set_quiet(rightp1);
121                 Dbl_copytoptr(rightp1,rightp2,dstptr);
122                 return(NOEXCEPTION);
123                 }
124             /*
125              * return quiet NaN
126              */
127             Dbl_copytoptr(leftp1,leftp2,dstptr);
128             return(NOEXCEPTION);
129             }
130         } /* End left NaN or Infinity processing */
131     /*
132      * check second operand for NaN's or infinity
133      */
134     if (Dbl_isinfinity_exponent(rightp1)) 
135         {
136         if (Dbl_iszero_mantissa(rightp1,rightp2)) 
137             {
138             /* return infinity */
139             Dbl_invert_sign(rightp1);
140             Dbl_copytoptr(rightp1,rightp2,dstptr);
141             return(NOEXCEPTION);
142             }
143         /*
144          * is NaN; signaling or quiet?
145          */
146         if (Dbl_isone_signaling(rightp1)) 
147             {
148             /* trap if INVALIDTRAP enabled */
149             if (Is_invalidtrap_enabled()) return(INVALIDEXCEPTION);
150             /* make NaN quiet */
151             Set_invalidflag();
152             Dbl_set_quiet(rightp1);
153             }
154         /*
155          * return quiet NaN
156          */
157         Dbl_copytoptr(rightp1,rightp2,dstptr);
158         return(NOEXCEPTION);
159         } /* End right NaN or Infinity processing */
160
161     /* Invariant: Must be dealing with finite numbers */
162
163     /* Compare operands by removing the sign */
164     Dbl_copytoint_exponentmantissap1(leftp1,signless_upper_left);
165     Dbl_copytoint_exponentmantissap1(rightp1,signless_upper_right);
166
167     /* sign difference selects add or sub operation. */
168     if(Dbl_ismagnitudeless(leftp2,rightp2,signless_upper_left,signless_upper_right))
169         {
170         /* Set the left operand to the larger one by XOR swap *
171          *  First finish the first word using "save"          */
172         Dbl_xorfromintp1(save,rightp1,/*to*/rightp1);
173         Dbl_xorfromintp1(save,leftp1,/*to*/leftp1);
174         Dbl_swap_lower(leftp2,rightp2);
175         result_exponent = Dbl_exponent(leftp1);
176         Dbl_invert_sign(leftp1);
177         }
178     /* Invariant:  left is not smaller than right. */ 
179
180     if((right_exponent = Dbl_exponent(rightp1)) == 0)
181         {
182         /* Denormalized operands.  First look for zeroes */
183         if(Dbl_iszero_mantissa(rightp1,rightp2)) 
184             {
185             /* right is zero */
186             if(Dbl_iszero_exponentmantissa(leftp1,leftp2))
187                 {
188                 /* Both operands are zeros */
189                 Dbl_invert_sign(rightp1);
190                 if(Is_rounding_mode(ROUNDMINUS))
191                     {
192                     Dbl_or_signs(leftp1,/*with*/rightp1);
193                     }
194                 else
195                     {
196                     Dbl_and_signs(leftp1,/*with*/rightp1);
197                     }
198                 }
199             else 
200                 {
201                 /* Left is not a zero and must be the result.  Trapped
202                  * underflows are signaled if left is denormalized.  Result
203                  * is always exact. */
204                 if( (result_exponent == 0) && Is_underflowtrap_enabled() )
205                     {
206                     /* need to normalize results mantissa */
207                     sign_save = Dbl_signextendedsign(leftp1);
208                     Dbl_leftshiftby1(leftp1,leftp2);
209                     Dbl_normalize(leftp1,leftp2,result_exponent);
210                     Dbl_set_sign(leftp1,/*using*/sign_save);
211                     Dbl_setwrapped_exponent(leftp1,result_exponent,unfl);
212                     Dbl_copytoptr(leftp1,leftp2,dstptr);
213                     /* inexact = FALSE */
214                     return(UNDERFLOWEXCEPTION);
215                     }
216                 }
217             Dbl_copytoptr(leftp1,leftp2,dstptr);
218             return(NOEXCEPTION);
219             }
220
221         /* Neither are zeroes */
222         Dbl_clear_sign(rightp1);        /* Exponent is already cleared */
223         if(result_exponent == 0 )
224             {
225             /* Both operands are denormalized.  The result must be exact
226              * and is simply calculated.  A sum could become normalized and a
227              * difference could cancel to a true zero. */
228             if( (/*signed*/int) save >= 0 )
229                 {
230                 Dbl_subtract(leftp1,leftp2,/*minus*/rightp1,rightp2,
231                  /*into*/resultp1,resultp2);
232                 if(Dbl_iszero_mantissa(resultp1,resultp2))
233                     {
234                     if(Is_rounding_mode(ROUNDMINUS))
235                         {
236                         Dbl_setone_sign(resultp1);
237                         }
238                     else
239                         {
240                         Dbl_setzero_sign(resultp1);
241                         }
242                     Dbl_copytoptr(resultp1,resultp2,dstptr);
243                     return(NOEXCEPTION);
244                     }
245                 }
246             else
247                 {
248                 Dbl_addition(leftp1,leftp2,rightp1,rightp2,
249                  /*into*/resultp1,resultp2);
250                 if(Dbl_isone_hidden(resultp1))
251                     {
252                     Dbl_copytoptr(resultp1,resultp2,dstptr);
253                     return(NOEXCEPTION);
254                     }
255                 }
256             if(Is_underflowtrap_enabled())
257                 {
258                 /* need to normalize result */
259                 sign_save = Dbl_signextendedsign(resultp1);
260                 Dbl_leftshiftby1(resultp1,resultp2);
261                 Dbl_normalize(resultp1,resultp2,result_exponent);
262                 Dbl_set_sign(resultp1,/*using*/sign_save);
263                 Dbl_setwrapped_exponent(resultp1,result_exponent,unfl);
264                 Dbl_copytoptr(resultp1,resultp2,dstptr);
265                 /* inexact = FALSE */
266                 return(UNDERFLOWEXCEPTION);
267                 }
268             Dbl_copytoptr(resultp1,resultp2,dstptr);
269             return(NOEXCEPTION);
270             }
271         right_exponent = 1;     /* Set exponent to reflect different bias
272                                  * with denomalized numbers. */
273         }
274     else
275         {
276         Dbl_clear_signexponent_set_hidden(rightp1);
277         }
278     Dbl_clear_exponent_set_hidden(leftp1);
279     diff_exponent = result_exponent - right_exponent;
280
281     /* 
282      * Special case alignment of operands that would force alignment 
283      * beyond the extent of the extension.  A further optimization
284      * could special case this but only reduces the path length for this
285      * infrequent case.
286      */
287     if(diff_exponent > DBL_THRESHOLD)
288         {
289         diff_exponent = DBL_THRESHOLD;
290         }
291     
292     /* Align right operand by shifting to right */
293     Dbl_right_align(/*operand*/rightp1,rightp2,/*shifted by*/diff_exponent,
294      /*and lower to*/extent);
295
296     /* Treat sum and difference of the operands separately. */
297     if( (/*signed*/int) save >= 0 )
298         {
299         /*
300          * Difference of the two operands.  Their can be no overflow.  A
301          * borrow can occur out of the hidden bit and force a post
302          * normalization phase.
303          */
304         Dbl_subtract_withextension(leftp1,leftp2,/*minus*/rightp1,rightp2,
305          /*with*/extent,/*into*/resultp1,resultp2);
306         if(Dbl_iszero_hidden(resultp1))
307             {
308             /* Handle normalization */
309             /* A straight forward algorithm would now shift the result
310              * and extension left until the hidden bit becomes one.  Not
311              * all of the extension bits need participate in the shift.
312              * Only the two most significant bits (round and guard) are
313              * needed.  If only a single shift is needed then the guard
314              * bit becomes a significant low order bit and the extension
315              * must participate in the rounding.  If more than a single 
316              * shift is needed, then all bits to the right of the guard 
317              * bit are zeros, and the guard bit may or may not be zero. */
318             sign_save = Dbl_signextendedsign(resultp1);
319             Dbl_leftshiftby1_withextent(resultp1,resultp2,extent,resultp1,resultp2);
320
321             /* Need to check for a zero result.  The sign and exponent
322              * fields have already been zeroed.  The more efficient test
323              * of the full object can be used.
324              */
325             if(Dbl_iszero(resultp1,resultp2))
326                 /* Must have been "x-x" or "x+(-x)". */
327                 {
328                 if(Is_rounding_mode(ROUNDMINUS)) Dbl_setone_sign(resultp1);
329                 Dbl_copytoptr(resultp1,resultp2,dstptr);
330                 return(NOEXCEPTION);
331                 }
332             result_exponent--;
333             /* Look to see if normalization is finished. */
334             if(Dbl_isone_hidden(resultp1))
335                 {
336                 if(result_exponent==0)
337                     {
338                     /* Denormalized, exponent should be zero.  Left operand *
339                      * was normalized, so extent (guard, round) was zero    */
340                     goto underflow;
341                     }
342                 else
343                     {
344                     /* No further normalization is needed. */
345                     Dbl_set_sign(resultp1,/*using*/sign_save);
346                     Ext_leftshiftby1(extent);
347                     goto round;
348                     }
349                 }
350
351             /* Check for denormalized, exponent should be zero.  Left    *
352              * operand was normalized, so extent (guard, round) was zero */
353             if(!(underflowtrap = Is_underflowtrap_enabled()) &&
354                result_exponent==0) goto underflow;
355
356             /* Shift extension to complete one bit of normalization and
357              * update exponent. */
358             Ext_leftshiftby1(extent);
359
360             /* Discover first one bit to determine shift amount.  Use a
361              * modified binary search.  We have already shifted the result
362              * one position right and still not found a one so the remainder
363              * of the extension must be zero and simplifies rounding. */
364             /* Scan bytes */
365             while(Dbl_iszero_hiddenhigh7mantissa(resultp1))
366                 {
367                 Dbl_leftshiftby8(resultp1,resultp2);
368                 if((result_exponent -= 8) <= 0  && !underflowtrap)
369                     goto underflow;
370                 }
371             /* Now narrow it down to the nibble */
372             if(Dbl_iszero_hiddenhigh3mantissa(resultp1))
373                 {
374                 /* The lower nibble contains the normalizing one */
375                 Dbl_leftshiftby4(resultp1,resultp2);
376                 if((result_exponent -= 4) <= 0 && !underflowtrap)
377                     goto underflow;
378                 }
379             /* Select case were first bit is set (already normalized)
380              * otherwise select the proper shift. */
381             if((jumpsize = Dbl_hiddenhigh3mantissa(resultp1)) > 7)
382                 {
383                 /* Already normalized */
384                 if(result_exponent <= 0) goto underflow;
385                 Dbl_set_sign(resultp1,/*using*/sign_save);
386                 Dbl_set_exponent(resultp1,/*using*/result_exponent);
387                 Dbl_copytoptr(resultp1,resultp2,dstptr);
388                 return(NOEXCEPTION);
389                 }
390             Dbl_sethigh4bits(resultp1,/*using*/sign_save);
391             switch(jumpsize) 
392                 {
393                 case 1:
394                     {
395                     Dbl_leftshiftby3(resultp1,resultp2);
396                     result_exponent -= 3;
397                     break;
398                     }
399                 case 2:
400                 case 3:
401                     {
402                     Dbl_leftshiftby2(resultp1,resultp2);
403                     result_exponent -= 2;
404                     break;
405                     }
406                 case 4:
407                 case 5:
408                 case 6:
409                 case 7:
410                     {
411                     Dbl_leftshiftby1(resultp1,resultp2);
412                     result_exponent -= 1;
413                     break;
414                     }
415                 }
416             if(result_exponent > 0) 
417                 {
418                 Dbl_set_exponent(resultp1,/*using*/result_exponent);
419                 Dbl_copytoptr(resultp1,resultp2,dstptr);
420                 return(NOEXCEPTION);            /* Sign bit is already set */
421                 }
422             /* Fixup potential underflows */
423           underflow:
424             if(Is_underflowtrap_enabled())
425                 {
426                 Dbl_set_sign(resultp1,sign_save);
427                 Dbl_setwrapped_exponent(resultp1,result_exponent,unfl);
428                 Dbl_copytoptr(resultp1,resultp2,dstptr);
429                 /* inexact = FALSE */
430                 return(UNDERFLOWEXCEPTION);
431                 }
432             /* 
433              * Since we cannot get an inexact denormalized result,
434              * we can now return.
435              */
436             Dbl_fix_overshift(resultp1,resultp2,(1-result_exponent),extent);
437             Dbl_clear_signexponent(resultp1);
438             Dbl_set_sign(resultp1,sign_save);
439             Dbl_copytoptr(resultp1,resultp2,dstptr);
440             return(NOEXCEPTION);
441             } /* end if(hidden...)... */
442         /* Fall through and round */
443         } /* end if(save >= 0)... */
444     else 
445         {
446         /* Subtract magnitudes */
447         Dbl_addition(leftp1,leftp2,rightp1,rightp2,/*to*/resultp1,resultp2);
448         if(Dbl_isone_hiddenoverflow(resultp1))
449             {
450             /* Prenormalization required. */
451             Dbl_rightshiftby1_withextent(resultp2,extent,extent);
452             Dbl_arithrightshiftby1(resultp1,resultp2);
453             result_exponent++;
454             } /* end if hiddenoverflow... */
455         } /* end else ...subtract magnitudes... */
456     
457     /* Round the result.  If the extension is all zeros,then the result is
458      * exact.  Otherwise round in the correct direction.  No underflow is
459      * possible. If a postnormalization is necessary, then the mantissa is
460      * all zeros so no shift is needed. */
461   round:
462     if(Ext_isnotzero(extent))
463         {
464         inexact = TRUE;
465         switch(Rounding_mode())
466             {
467             case ROUNDNEAREST: /* The default. */
468             if(Ext_isone_sign(extent))
469                 {
470                 /* at least 1/2 ulp */
471                 if(Ext_isnotzero_lower(extent)  ||
472                   Dbl_isone_lowmantissap2(resultp2))
473                     {
474                     /* either exactly half way and odd or more than 1/2ulp */
475                     Dbl_increment(resultp1,resultp2);
476                     }
477                 }
478             break;
479
480             case ROUNDPLUS:
481             if(Dbl_iszero_sign(resultp1))
482                 {
483                 /* Round up positive results */
484                 Dbl_increment(resultp1,resultp2);
485                 }
486             break;
487             
488             case ROUNDMINUS:
489             if(Dbl_isone_sign(resultp1))
490                 {
491                 /* Round down negative results */
492                 Dbl_increment(resultp1,resultp2);
493                 }
494             
495             case ROUNDZERO:;
496             /* truncate is simple */
497             } /* end switch... */
498         if(Dbl_isone_hiddenoverflow(resultp1)) result_exponent++;
499         }
500     if(result_exponent == DBL_INFINITY_EXPONENT)
501         {
502         /* Overflow */
503         if(Is_overflowtrap_enabled())
504             {
505             Dbl_setwrapped_exponent(resultp1,result_exponent,ovfl);
506             Dbl_copytoptr(resultp1,resultp2,dstptr);
507             if (inexact)
508             if (Is_inexacttrap_enabled())
509                 return(OVERFLOWEXCEPTION | INEXACTEXCEPTION);
510                 else Set_inexactflag();
511             return(OVERFLOWEXCEPTION);
512             }
513         else
514             {
515             inexact = TRUE;
516             Set_overflowflag();
517             Dbl_setoverflow(resultp1,resultp2);
518             }
519         }
520     else Dbl_set_exponent(resultp1,result_exponent);
521     Dbl_copytoptr(resultp1,resultp2,dstptr);
522     if(inexact) 
523         if(Is_inexacttrap_enabled()) return(INEXACTEXCEPTION);
524         else Set_inexactflag();
525     return(NOEXCEPTION);
526     }