1 // Copyright (C) 2006 Mathias Froehlich - Mathias.Froehlich@web.de
3 // This library is free software; you can redistribute it and/or
4 // modify it under the terms of the GNU Library General Public
5 // License as published by the Free Software Foundation; either
6 // version 2 of the License, or (at your option) any later version.
8 // This library is distributed in the hope that it will be useful,
9 // but WITHOUT ANY WARRANTY; without even the implied warranty of
10 // MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the GNU
11 // Library General Public License for more details.
13 // You should have received a copy of the GNU General Public License
14 // along with this program; if not, write to the Free Software
15 // Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301, USA.
24 static T pi() { return T(3.1415926535897932384626433832795029L); }
25 static T twopi() { return 2*T(3.1415926535897932384626433832795029L); }
27 static T min(const T& a, const T& b)
28 { return a < b ? a : b; }
29 static T min(const T& a, const T& b, const T& c)
30 { return min(min(a, b), c); }
31 static T min(const T& a, const T& b, const T& c, const T& d)
32 { return min(min(min(a, b), c), d); }
33 static T max(const T& a, const T& b)
34 { return a > b ? a : b; }
35 static T max(const T& a, const T& b, const T& c)
36 { return max(max(a, b), c); }
37 static T max(const T& a, const T& b, const T& c, const T& d)
38 { return max(max(max(a, b), c), d); }
40 // clip the value of a to be in the range between and including _min and _max
41 static T clip(const T& a, const T& _min, const T& _max)
42 { return max(_min, min(_max, a)); }
45 /// Add two (integer) values taking care of overflows.
46 static T addClipOverflow(T a, T b)
50 if( SGLimits<T>::max() - b < a )
51 return SGLimits<T>::max();
55 if( SGLimits<T>::min() - b > a )
56 return SGLimits<T>::min();
62 /// Add two (integer) values in place, taking care of overflows.
63 static T& addClipOverflowInplace(T& a, T b)
65 return a = addClipOverflow(a, b);
69 * Seek a variable towards a target value with given rate and timestep
71 * @param var Variable or eg. SGPropObj
72 * @param target Target value
73 * @param rate Max. change rate/sec
74 * @param dt Time step (sec)
77 static T seek(Var& var, T target, T rate, T dt)
80 return var = min(var + rate * dt, target);
82 return var = max(var - rate * dt, target);
86 * Get @c base raised to the power of @c N
95 ? (1. / pow<-N>(base))
96 : ( ((N & 1) ? base : 1)
97 * ((N > 1) ? pow<N / 2>(base * base) : 1)
101 static int sign(const T& a)
103 if (a < -SGLimits<T>::min())
105 else if (SGLimits<T>::min() < a)
111 static T rad2deg(const T& val)
112 { return val*180/pi(); }
113 static T deg2rad(const T& val)
114 { return val*pi()/180; }
116 // normalize the value to be in a range between [min, max[
118 normalizePeriodic(const T& min, const T& max, const T& value)
121 if (range < SGLimits<T>::min())
123 T normalized = value - range*floor((value - min)/range);
124 // two security checks that can only happen due to roundoff
125 if (normalized <= min)
127 if (max <= normalized)
132 // normalize the angle to be in a range between [-pi, pi[
134 normalizeAngle(const T& angle)
135 { return normalizePeriodic(-pi(), pi(), angle); }
137 // normalize the angle to be in a range between [0, 2pi[
139 normalizeAngle2(const T& angle)
140 { return normalizePeriodic(0, twopi(), angle); }
142 static T round(const T& v)
143 { return floor(v + T(0.5)); }
144 static int roundToInt(const T& v)
145 { return int(round(v)); }
147 // Linear interpolation between two arbitrary typed values
149 static S lerp(const S& val0, const S& val1, const T& t)
150 { return val0*(T(1) - t) + val1*t; }
152 /// Returns true if v is a NaN value
153 /// Use with care: allways code that you do not need to use that!
154 static bool isNaN(const T& v)
158 #elif defined HAVE_STD_ISNAN
159 return std::isnan(v);
161 // Use that every compare involving a NaN returns false
162 // But be careful, some usual compiler switches like for example
163 // -fast-math from gcc might optimize that expression to v != v which
164 // behaves exactly like the opposite ...