Add lrint() and associated functions.
[dragonfly.git] / lib / msun / src / lrintf.c
1 /* $NetBSD: lrintf.c,v 1.2 2004/07/01 16:06:30 drochner Exp $ */
2 /* $DragonFly: src/lib/msun/src/Attic/lrintf.c,v 1.1 2004/12/30 16:10:18 asmodai Exp $ */
3
4 /*-
5  * Copyright (c) 2004
6  *      Matthias Drochner. All rights reserved.
7  *
8  * Redistribution and use in source and binary forms, with or without
9  * modification, are permitted provided that the following conditions
10  * are met:
11  * 1. Redistributions of source code must retain the above copyright
12  *    notice, this list of conditions and the following disclaimer.
13  * 2. Redistributions in binary form must reproduce the above copyright
14  *    notice, this list of conditions and the following disclaimer in the
15  *    documentation and/or other materials provided with the distribution.
16  *
17  * THIS SOFTWARE IS PROVIDED BY THE AUTHOR AND CONTRIBUTORS ``AS IS'' AND
18  * ANY EXPRESS OR IMPLIED WARRANTIES, INCLUDING, BUT NOT LIMITED TO, THE
19  * IMPLIED WARRANTIES OF MERCHANTABILITY AND FITNESS FOR A PARTICULAR PURPOSE
20  * ARE DISCLAIMED.  IN NO EVENT SHALL THE AUTHOR OR CONTRIBUTORS BE LIABLE
21  * FOR ANY DIRECT, INDIRECT, INCIDENTAL, SPECIAL, EXEMPLARY, OR CONSEQUENTIAL
22  * DAMAGES (INCLUDING, BUT NOT LIMITED TO, PROCUREMENT OF SUBSTITUTE GOODS
23  * OR SERVICES; LOSS OF USE, DATA, OR PROFITS; OR BUSINESS INTERRUPTION)
24  * HOWEVER CAUSED AND ON ANY THEORY OF LIABILITY, WHETHER IN CONTRACT, STRICT
25  * LIABILITY, OR TORT (INCLUDING NEGLIGENCE OR OTHERWISE) ARISING IN ANY WAY
26  * OUT OF THE USE OF THIS SOFTWARE, EVEN IF ADVISED OF THE POSSIBILITY OF
27  * SUCH DAMAGE.
28  */
29
30 #include <math.h>
31 #include <sys/ieee754.h>
32 #include <machine/limits.h>
33 #include "math_private.h"
34
35 #ifndef LRINTNAME
36 #define LRINTNAME lrintf
37 #define RESTYPE long int
38 #define RESTYPE_MIN LONG_MIN
39 #define RESTYPE_MAX LONG_MAX
40 #endif
41
42 #define RESTYPE_BITS (sizeof(RESTYPE) * 8)
43
44 static const float
45 TWO23[2]={
46   8.3886080000e+06, /* 0x4b000000 */
47  -8.3886080000e+06, /* 0xcb000000 */
48 };
49
50 RESTYPE
51 LRINTNAME(float x)
52 {
53         u_int32_t i0;
54         int e, s, shift;
55         RESTYPE res;
56
57         GET_FLOAT_WORD(i0, x);
58         e = i0 >> SNG_FRACBITS;
59         s = e >> SNG_EXPBITS;
60         e = (e & 0xff) - SNG_EXP_BIAS;
61
62         /* 1.0 x 2^-1 is the smallest number which can be rounded to 1 */
63         if (e < -1)
64                 return (0);
65         /* 1.0 x 2^31 (or 2^63) is already too large */
66         if (e >= (int)RESTYPE_BITS - 1)
67                 return (s ? RESTYPE_MIN : RESTYPE_MAX); /* ??? unspecified */
68
69         /* >= 2^23 is already an exact integer */
70         if (e < SNG_FRACBITS) {
71                 /* round, using current direction */
72                 x += TWO23[s];
73                 x -= TWO23[s];
74         }
75
76         GET_FLOAT_WORD(i0, x);
77         e = ((i0 >> SNG_FRACBITS) & 0xff) - SNG_EXP_BIAS;
78         i0 &= 0x7fffff;
79         i0 |= (1 << SNG_FRACBITS);
80
81         shift = e - SNG_FRACBITS;
82         if (shift >=0)
83                 res = (shift < 32 ? (RESTYPE)i0 << shift : 0);
84         else
85                 res = (shift > -32 ? i0 >> -shift : 0);
86
87         return (s ? -res : res);
88 }