Apply clang-format to source tree
[alexxy/gromacs.git] / src / gromacs / math / utilities.cpp
1 /*
2  * This file is part of the GROMACS molecular simulation package.
3  *
4  * Copyright (c) 1991-2000, University of Groningen, The Netherlands.
5  * Copyright (c) 2001-2004, The GROMACS development team.
6  * Copyright (c) 2013,2014,2015,2016,2018,2019, by the GROMACS development team, led by
7  * Mark Abraham, David van der Spoel, Berk Hess, and Erik Lindahl,
8  * and including many others, as listed in the AUTHORS file in the
9  * top-level source directory and at http://www.gromacs.org.
10  *
11  * GROMACS is free software; you can redistribute it and/or
12  * modify it under the terms of the GNU Lesser General Public License
13  * as published by the Free Software Foundation; either version 2.1
14  * of the License, or (at your option) any later version.
15  *
16  * GROMACS is distributed in the hope that it will be useful,
17  * but WITHOUT ANY WARRANTY; without even the implied warranty of
18  * MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE.  See the GNU
19  * Lesser General Public License for more details.
20  *
21  * You should have received a copy of the GNU Lesser General Public
22  * License along with GROMACS; if not, see
23  * http://www.gnu.org/licenses, or write to the Free Software Foundation,
24  * Inc., 51 Franklin Street, Fifth Floor, Boston, MA  02110-1301  USA.
25  *
26  * If you want to redistribute modifications to GROMACS, please
27  * consider that scientific software is very special. Version
28  * control is crucial - bugs must be traceable. We will be happy to
29  * consider code for inclusion in the official distribution, but
30  * derived work must not be called official GROMACS. Details are found
31  * in the README & COPYING files - if they are missing, get the
32  * official version at http://www.gromacs.org.
33  *
34  * To help us fund GROMACS development, we humbly ask that you cite
35  * the research papers on the package. Check out http://www.gromacs.org.
36  */
37 #include "gmxpre.h"
38
39 #include "utilities.h"
40
41 #include "config.h"
42
43 #include <cassert>
44 #include <climits>
45 #include <cmath>
46
47 #include <algorithm>
48
49 #include <cfenv>
50
51 //! Floating point exception set that we use and care about
52 constexpr int c_FPexceptions = FE_DIVBYZERO | FE_INVALID | FE_OVERFLOW;
53
54 bool gmx_within_tol(double f1, double f2, double tol)
55 {
56     /* The or-equal is important - otherwise we return false if f1==f2==0 */
57     return fabs(f1 - f2) <= tol * 0.5 * (fabs(f1) + fabs(f2));
58 }
59
60 bool gmx_numzero(double a)
61 {
62     return gmx_within_tol(a, 0.0, GMX_REAL_MIN / GMX_REAL_EPS);
63 }
64
65
66 gmx_bool check_int_multiply_for_overflow(int64_t a, int64_t b, int64_t* result)
67 {
68     int64_t sign = 1;
69     if ((0 == a) || (0 == b))
70     {
71         *result = 0;
72         return TRUE;
73     }
74     if (a < 0)
75     {
76         a    = -a;
77         sign = -sign;
78     }
79     if (b < 0)
80     {
81         b    = -b;
82         sign = -sign;
83     }
84     if (INT64_MAX / b < a)
85     {
86         *result = (sign > 0) ? INT64_MAX : INT64_MIN;
87         return FALSE;
88     }
89     *result = sign * a * b;
90     return TRUE;
91 }
92
93 int gmx_greatest_common_divisor(int p, int q)
94 {
95     int tmp;
96     while (q != 0)
97     {
98         tmp = q;
99         q   = p % q;
100         p   = tmp;
101     }
102     return p;
103 }
104
105 int gmx_feenableexcept()
106 {
107 #if HAVE_FEENABLEEXCEPT
108     return feenableexcept(c_FPexceptions);
109 #elif (defined(__i386__) || defined(__x86_64__)) && defined(__APPLE__)
110     /* Author:  David N. Williams
111      * License:  Public Domain
112      *
113      * Might also work on non-Apple Unix. But should be tested
114      * before enabling.
115      */
116     static fenv_t fenv;
117     unsigned int  new_excepts = c_FPexceptions & FE_ALL_EXCEPT;
118
119     if (fegetenv(&fenv))
120     {
121         return -1;
122     }
123
124     // unmask
125     fenv.__control &= ~new_excepts;
126     fenv.__mxcsr &= ~(new_excepts << 7);
127
128     return fesetenv(&fenv);
129 #else
130     return -1;
131 #endif
132 }
133
134 int gmx_fedisableexcept()
135 {
136 #if HAVE_FEDISABLEEXCEPT
137     return fedisableexcept(c_FPexceptions);
138 #elif (defined(__i386__) || defined(__x86_64__)) && defined(__APPLE__)
139     static fenv_t fenv;
140     unsigned int  new_excepts = c_FPexceptions & FE_ALL_EXCEPT;
141     if (fegetenv(&fenv))
142     {
143         return -1;
144     }
145
146     // mask
147     fenv.__control |= new_excepts;
148     fenv.__mxcsr |= new_excepts << 7;
149
150     return fesetenv(&fenv);
151 #else
152     return -1;
153 #endif
154 }
155
156 real max_cutoff(real cutoff1, real cutoff2)
157 {
158     if (cutoff1 == 0 || cutoff2 == 0)
159     {
160         return 0;
161     }
162     else
163     {
164         return std::max(cutoff1, cutoff2);
165     }
166 }