| cc68a136 |
1 | /* @(#)s_floor.c 5.1 93/09/24 */ |
| 2 | /* |
| 3 | * ==================================================== |
| 4 | * Copyright (C) 1993 by Sun Microsystems, Inc. All rights reserved. |
| 5 | * |
| 6 | * Developed at SunPro, a Sun Microsystems, Inc. business. |
| 7 | * Permission to use, copy, modify, and distribute this |
| 8 | * software is freely granted, provided that this notice |
| 9 | * is preserved. |
| 10 | * ==================================================== |
| 11 | */ |
| 12 | |
| 13 | #if defined(LIBM_SCCS) && !defined(lint) |
| 14 | static char rcsid[] = "$NetBSD: s_floor.c,v 1.8 1995/05/10 20:47:20 jtc Exp $"; |
| 15 | #endif |
| 16 | |
| 17 | /* |
| 18 | * floor(x) |
| 19 | * Return x rounded toward -inf to integral value |
| 20 | * Method: |
| 21 | * Bit twiddling. |
| 22 | * Exception: |
| 23 | * Inexact flag raised if x not equal to floor(x). |
| 24 | */ |
| 25 | |
| 26 | #include "math.h" |
| 27 | #include "math_private.h" |
| 28 | |
| 29 | #ifdef __STDC__ |
| 30 | static const double huge = 1.0e300; |
| 31 | #else |
| 32 | static double huge = 1.0e300; |
| 33 | #endif |
| 34 | |
| 35 | #ifdef __STDC__ |
| 36 | double floor(double x) |
| 37 | #else |
| 38 | double floor(x) |
| 39 | double x; |
| 40 | #endif |
| 41 | { |
| 42 | int32_t i0,i1,j0; |
| 43 | u_int32_t i,j; |
| 44 | EXTRACT_WORDS(i0,i1,x); |
| 45 | j0 = ((i0>>20)&0x7ff)-0x3ff; |
| 46 | if(j0<20) { |
| 47 | if(j0<0) { /* raise inexact if x != 0 */ |
| 48 | if(huge+x>0.0) {/* return 0*sign(x) if |x|<1 */ |
| 49 | if(i0>=0) {i0=i1=0;} |
| 50 | else if(((i0&0x7fffffff)|i1)!=0) |
| 51 | { i0=0xbff00000;i1=0;} |
| 52 | } |
| 53 | } else { |
| 54 | i = (0x000fffff)>>j0; |
| 55 | if(((i0&i)|i1)==0) return x; /* x is integral */ |
| 56 | if(huge+x>0.0) { /* raise inexact flag */ |
| 57 | if(i0<0) i0 += (0x00100000)>>j0; |
| 58 | i0 &= (~i); i1=0; |
| 59 | } |
| 60 | } |
| 61 | } else if (j0>51) { |
| 62 | if(j0==0x400) return x+x; /* inf or NaN */ |
| 63 | else return x; /* x is integral */ |
| 64 | } else { |
| 65 | i = ((u_int32_t)(0xffffffff))>>(j0-20); |
| 66 | if((i1&i)==0) return x; /* x is integral */ |
| 67 | if(huge+x>0.0) { /* raise inexact flag */ |
| 68 | if(i0<0) { |
| 69 | if(j0==20) i0+=1; |
| 70 | else { |
| 71 | j = i1+(1<<(52-j0)); |
| 72 | if(j<i1) i0 +=1 ; /* got a carry */ |
| 73 | i1=j; |
| 74 | } |
| 75 | } |
| 76 | i1 &= (~i); |
| 77 | } |
| 78 | } |
| 79 | INSERT_WORDS(x,i0,i1); |
| 80 | return x; |
| 81 | } |
notaz.gp2x.de / picodrive.git / blame