2004-08-31 21:19:30 +08:00
|
|
|
/* -*-c++-*- OpenSceneGraph - Copyright (C) 1998-2004 Robert Osfield
|
2003-01-22 00:45:36 +08:00
|
|
|
*
|
|
|
|
* This library is open source and may be redistributed and/or modified under
|
|
|
|
* the terms of the OpenSceneGraph Public License (OSGPL) version 0.0 or
|
|
|
|
* (at your option) any later version. The full license is in LICENSE file
|
|
|
|
* included with this distribution, and on the openscenegraph.org website.
|
|
|
|
*
|
|
|
|
* This library is distributed in the hope that it will be useful,
|
|
|
|
* but WITHOUT ANY WARRANTY; without even the implied warranty of
|
|
|
|
* MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
|
|
|
|
* OpenSceneGraph Public License for more details.
|
|
|
|
*/
|
2001-10-04 23:12:57 +08:00
|
|
|
|
2001-10-04 05:44:07 +08:00
|
|
|
#ifndef __OSG_MATH
|
|
|
|
#define __OSG_MATH
|
|
|
|
|
|
|
|
#include <math.h>
|
|
|
|
|
2008-11-23 19:35:43 +08:00
|
|
|
#include <osg/Export>
|
|
|
|
|
2006-02-06 05:53:37 +08:00
|
|
|
//certain math functions were not defined until 10.2
|
|
|
|
//so this code checks the version so it can add in workarounds for older versions.
|
|
|
|
#ifdef __APPLE__
|
2006-08-25 04:16:25 +08:00
|
|
|
// Using std::isnan will work for OS X, but use of <cmath>
|
|
|
|
// and std:: are not necessarily portible with other systems so
|
|
|
|
// the include of <cmath> is isolated here.
|
|
|
|
#include <cmath>
|
2006-02-06 05:53:37 +08:00
|
|
|
#include <AvailabilityMacros.h>
|
|
|
|
#if !defined(MAC_OS_X_VERSION_10_2) || (MAC_OS_X_VERSION_MIN_REQUIRED < MAC_OS_X_VERSION_10_2)
|
2006-05-15 19:53:21 +08:00
|
|
|
// One extra check to verify the gcc version.
|
|
|
|
// The assumption is that there is no possible way to use gcc 4+
|
|
|
|
// on anything less than 10.3.9. So if gcc 4 is in use, this means
|
|
|
|
// pre-10.2 support is not intended and we need not define APPLE_PRE_10_2.
|
|
|
|
// The reason for this extra check is that if the user relies on default
|
|
|
|
// settings, MAC_OS_X_VERSION_MIN_REQUIRED will be set to 1010 and hit
|
|
|
|
// this code path, but this is probably not what they want if using gcc 4+.
|
|
|
|
#if (__GNUC__ < 4)
|
|
|
|
#define APPLE_PRE_10_2
|
|
|
|
#endif
|
2006-02-06 05:53:37 +08:00
|
|
|
#endif
|
|
|
|
#endif
|
2002-11-08 20:26:41 +08:00
|
|
|
|
2005-05-20 23:45:12 +08:00
|
|
|
#if defined(_MSC_VER)
|
2002-08-26 21:04:43 +08:00
|
|
|
#include <float.h>
|
|
|
|
#endif
|
|
|
|
|
2009-03-10 19:14:56 +08:00
|
|
|
#if defined (sun) || \
|
|
|
|
defined (__APPLE__) || \
|
|
|
|
(defined (_AIX) && defined (__GNUC__))
|
2002-03-15 00:01:21 +08:00
|
|
|
|
2001-11-06 18:34:51 +08:00
|
|
|
#include <float.h>
|
2001-10-04 05:44:07 +08:00
|
|
|
|
2002-03-15 00:01:21 +08:00
|
|
|
#ifndef acosf
|
2005-05-13 19:11:52 +08:00
|
|
|
inline float acosf(float value) { return static_cast<float>(acos(value)); }
|
2002-03-15 00:01:21 +08:00
|
|
|
#endif
|
2001-10-04 05:44:07 +08:00
|
|
|
|
2002-03-15 00:01:21 +08:00
|
|
|
#ifndef asinf
|
2005-05-13 19:11:52 +08:00
|
|
|
inline float asinf(float value) { return static_cast<float>(asin(value)); }
|
2002-03-15 00:01:21 +08:00
|
|
|
#endif
|
2001-10-04 05:44:07 +08:00
|
|
|
|
2002-03-15 00:01:21 +08:00
|
|
|
#ifndef cosf
|
2005-05-13 19:11:52 +08:00
|
|
|
inline float cosf(float value) { return static_cast<float>(cos(value)); }
|
2002-03-15 00:01:21 +08:00
|
|
|
#endif
|
2001-10-04 05:44:07 +08:00
|
|
|
|
2002-03-15 00:01:21 +08:00
|
|
|
#ifndef sinf
|
2005-05-13 19:11:52 +08:00
|
|
|
inline float sinf(float value) { return static_cast<float>(sin(value)); }
|
2002-03-15 00:01:21 +08:00
|
|
|
#endif
|
2001-10-04 05:44:07 +08:00
|
|
|
|
2002-03-15 00:01:21 +08:00
|
|
|
#ifndef logf
|
2005-05-13 19:11:52 +08:00
|
|
|
inline float logf(float value) { return static_cast<float>(log(value)); }
|
2002-03-15 00:01:21 +08:00
|
|
|
#endif
|
2001-10-04 05:44:07 +08:00
|
|
|
|
2002-03-15 00:01:21 +08:00
|
|
|
#ifndef powf
|
2005-05-13 19:11:52 +08:00
|
|
|
inline float powf(float value1,float value2) { return static_cast<float>(pow(value1,value2)); }
|
2002-03-15 00:01:21 +08:00
|
|
|
#endif
|
2001-10-04 05:44:07 +08:00
|
|
|
|
2002-03-15 00:01:21 +08:00
|
|
|
#ifndef sqrtf
|
2005-05-13 19:11:52 +08:00
|
|
|
inline float sqrtf(float value) { return static_cast<float>(sqrt(value)); }
|
2002-03-15 00:01:21 +08:00
|
|
|
#endif
|
2002-08-30 23:32:59 +08:00
|
|
|
|
2002-03-15 00:01:21 +08:00
|
|
|
#ifndef fabsf
|
2005-05-13 19:11:52 +08:00
|
|
|
inline float fabsf(float value) { return static_cast<float>(fabs(value)); }
|
2002-03-15 00:01:21 +08:00
|
|
|
#endif
|
2001-11-06 18:34:51 +08:00
|
|
|
|
2004-02-02 16:55:17 +08:00
|
|
|
#ifndef atan2f
|
2005-05-13 19:11:52 +08:00
|
|
|
inline float atan2f(float value1, float value2) { return static_cast<float>(atan2(value1,value2)); }
|
2004-02-02 16:55:17 +08:00
|
|
|
#endif
|
|
|
|
|
2009-11-18 20:15:29 +08:00
|
|
|
#ifndef fmodf
|
|
|
|
inline float fmodf(float value1, float value2) { return static_cast<float>(fmod(value1,value2)); }
|
|
|
|
#endif
|
|
|
|
|
2006-08-02 18:43:26 +08:00
|
|
|
#ifndef tanf
|
|
|
|
inline float tanf(float value) { return static_cast<float>(tan(value)); }
|
|
|
|
#endif
|
|
|
|
|
2002-08-30 23:32:59 +08:00
|
|
|
#endif
|
|
|
|
|
2002-07-23 23:01:51 +08:00
|
|
|
|
2005-05-20 23:45:12 +08:00
|
|
|
#if defined (sun) || \
|
2005-04-06 03:08:48 +08:00
|
|
|
defined (__hpux) || \
|
2009-03-10 19:14:56 +08:00
|
|
|
defined (APPLE_PRE_10_2) || \
|
|
|
|
(defined (_AIX) && defined (__GNUC__))
|
2002-07-23 23:01:51 +08:00
|
|
|
|
|
|
|
#ifndef floorf
|
2005-05-13 19:11:52 +08:00
|
|
|
inline float floorf(float value) { return static_cast<float>(floor(value)); }
|
2002-07-23 23:01:51 +08:00
|
|
|
#endif
|
2002-04-20 00:22:25 +08:00
|
|
|
|
2006-08-02 18:43:26 +08:00
|
|
|
#ifndef ceilf
|
|
|
|
inline float ceilf(float value) { return static_cast<float>(ceil(value)); }
|
|
|
|
#endif
|
|
|
|
|
2002-03-15 00:01:21 +08:00
|
|
|
#endif
|
2001-11-06 18:34:51 +08:00
|
|
|
|
2001-10-04 05:44:07 +08:00
|
|
|
namespace osg {
|
|
|
|
|
2004-08-31 21:19:30 +08:00
|
|
|
// define the standard trig values
|
2002-02-09 18:24:39 +08:00
|
|
|
#ifdef PI
|
|
|
|
#undef PI
|
|
|
|
#undef PI_2
|
|
|
|
#undef PI_4
|
|
|
|
#endif
|
2002-01-30 23:27:45 +08:00
|
|
|
const double PI = 3.14159265358979323846;
|
|
|
|
const double PI_2 = 1.57079632679489661923;
|
|
|
|
const double PI_4 = 0.78539816339744830962;
|
2007-09-12 01:08:06 +08:00
|
|
|
const double LN_2 = 0.69314718055994530942;
|
|
|
|
const double INVLN_2 = 1.0 / LN_2;
|
|
|
|
|
2002-01-30 23:27:45 +08:00
|
|
|
|
2004-08-31 21:19:30 +08:00
|
|
|
/** return the minimum of two values, equivalent to std::min.
|
|
|
|
* std::min not used because of STL implementation under IRIX not
|
|
|
|
* containing std::min.
|
|
|
|
*/
|
2003-04-08 17:42:03 +08:00
|
|
|
template<typename T>
|
|
|
|
inline T absolute(T v) { return v<(T)0?-v:v; }
|
|
|
|
|
2004-08-31 21:19:30 +08:00
|
|
|
/** return true if float lhs and rhs are equivalent,
|
|
|
|
* meaning that the difference between them is less than an epsilon value
|
|
|
|
* which defaults to 1e-6.
|
|
|
|
*/
|
2006-10-02 21:11:32 +08:00
|
|
|
inline bool equivalent(float lhs,float rhs,float epsilon=1e-6)
|
2004-08-31 21:19:30 +08:00
|
|
|
{ float delta = rhs-lhs; return delta<0.0f?delta>=-epsilon:delta<=epsilon; }
|
2003-06-24 23:40:09 +08:00
|
|
|
|
2004-08-31 21:19:30 +08:00
|
|
|
/** return true if double lhs and rhs are equivalent,
|
|
|
|
* meaning that the difference between them is less than an epsilon value
|
|
|
|
* which defaults to 1e-6.
|
|
|
|
*/
|
2006-10-02 21:11:32 +08:00
|
|
|
inline bool equivalent(double lhs,double rhs,double epsilon=1e-6)
|
2004-08-31 21:19:30 +08:00
|
|
|
{ double delta = rhs-lhs; return delta<0.0?delta>=-epsilon:delta<=epsilon; }
|
2003-06-24 23:40:09 +08:00
|
|
|
|
2007-12-11 01:30:18 +08:00
|
|
|
/** return the minimum of two values, equivalent to std::min.
|
2004-08-31 21:19:30 +08:00
|
|
|
* std::min not used because of STL implementation under IRIX not containing
|
|
|
|
* std::min.
|
|
|
|
*/
|
2003-02-24 20:02:00 +08:00
|
|
|
template<typename T>
|
|
|
|
inline T minimum(T lhs,T rhs) { return lhs<rhs?lhs:rhs; }
|
|
|
|
|
2007-12-11 01:30:18 +08:00
|
|
|
/** return the maximum of two values, equivalent to std::max.
|
2004-08-31 21:19:30 +08:00
|
|
|
* std::max not used because of STL implementation under IRIX not containing
|
|
|
|
* std::max.
|
|
|
|
*/
|
2003-02-24 20:02:00 +08:00
|
|
|
template<typename T>
|
|
|
|
inline T maximum(T lhs,T rhs) { return lhs>rhs?lhs:rhs; }
|
|
|
|
|
2002-05-14 05:19:42 +08:00
|
|
|
template<typename T>
|
2004-08-31 21:19:30 +08:00
|
|
|
inline T clampTo(T v,T minimum,T maximum)
|
|
|
|
{ return v<minimum?minimum:v>maximum?maximum:v; }
|
2002-01-30 23:27:45 +08:00
|
|
|
|
2002-05-21 16:59:26 +08:00
|
|
|
template<typename T>
|
|
|
|
inline T clampAbove(T v,T minimum) { return v<minimum?minimum:v; }
|
|
|
|
|
|
|
|
template<typename T>
|
|
|
|
inline T clampBelow(T v,T maximum) { return v>maximum?maximum:v; }
|
|
|
|
|
2004-06-04 19:35:13 +08:00
|
|
|
template<typename T>
|
2004-08-31 21:19:30 +08:00
|
|
|
inline T clampBetween(T v,T minimum, T maximum)
|
|
|
|
{ return clampBelow(clampAbove(v,minimum),maximum); }
|
2004-06-04 19:35:13 +08:00
|
|
|
|
2002-05-14 05:19:42 +08:00
|
|
|
template<typename T>
|
2002-05-30 03:34:01 +08:00
|
|
|
inline T sign(T v) { return v<(T)0?(T)-1:(T)1; }
|
2001-10-04 05:44:07 +08:00
|
|
|
|
2007-05-09 17:26:33 +08:00
|
|
|
template<typename T>
|
|
|
|
inline T signOrZero(T v) { return v<(T)0 ? (T)-1 : ( v>(T)0 ? (T)1 : 0 ); }
|
|
|
|
|
2002-05-14 05:19:42 +08:00
|
|
|
template<typename T>
|
|
|
|
inline T square(T v) { return v*v; }
|
|
|
|
|
|
|
|
template<typename T>
|
2002-05-30 03:34:01 +08:00
|
|
|
inline T signedSquare(T v) { return v<(T)0?-v*v:v*v;; }
|
2002-05-14 05:19:42 +08:00
|
|
|
|
2002-07-03 03:53:18 +08:00
|
|
|
inline float inDegrees(float angle) { return angle*(float)PI/180.0f; }
|
|
|
|
inline double inDegrees(double angle) { return angle*PI/180.0; }
|
2002-05-14 05:19:42 +08:00
|
|
|
|
|
|
|
template<typename T>
|
|
|
|
inline T inRadians(T angle) { return angle; }
|
|
|
|
|
2002-07-03 03:53:18 +08:00
|
|
|
inline float DegreesToRadians(float angle) { return angle*(float)PI/180.0f; }
|
|
|
|
inline double DegreesToRadians(double angle) { return angle*PI/180.0; }
|
2002-05-14 05:19:42 +08:00
|
|
|
|
2002-07-03 03:53:18 +08:00
|
|
|
inline float RadiansToDegrees(float angle) { return angle*180.0f/(float)PI; }
|
|
|
|
inline double RadiansToDegrees(double angle) { return angle*180.0/PI; }
|
2006-05-09 17:35:12 +08:00
|
|
|
|
|
|
|
inline float round(float v) { return v>=0.0f?floorf(v+0.5f):ceilf(v-0.5f); }
|
|
|
|
inline double round(double v) { return v>=0.0?floor(v+0.5):ceil(v-0.5); }
|
2001-10-07 04:29:42 +08:00
|
|
|
|
2009-11-18 20:15:29 +08:00
|
|
|
#if defined(_WIN32) && !defined(__CYGWIN__) && !defined(__MWERKS__)
|
2002-01-18 22:12:36 +08:00
|
|
|
inline bool isNaN(float v) { return _isnan(v)!=0; }
|
|
|
|
inline bool isNaN(double v) { return _isnan(v)!=0; }
|
2001-11-06 18:34:51 +08:00
|
|
|
#else
|
2006-05-15 19:53:21 +08:00
|
|
|
#if defined(__APPLE__)
|
2006-08-25 04:16:25 +08:00
|
|
|
inline bool isNaN(float v) { return std::isnan(v); }
|
|
|
|
inline bool isNaN(double v) { return std::isnan(v); }
|
2002-11-08 20:26:41 +08:00
|
|
|
#else
|
2006-05-15 19:53:21 +08:00
|
|
|
// Need to use to std::isnan to avoid undef problem from <cmath>
|
2002-11-08 20:26:41 +08:00
|
|
|
inline bool isNaN(float v) { return isnan(v); }
|
|
|
|
inline bool isNaN(double v) { return isnan(v); }
|
|
|
|
#endif
|
2001-11-06 18:34:51 +08:00
|
|
|
#endif
|
|
|
|
|
2002-06-15 20:14:42 +08:00
|
|
|
|
2004-08-31 21:19:30 +08:00
|
|
|
/** compute the volume of a tetrahedron. */
|
2002-06-15 20:14:42 +08:00
|
|
|
template<typename T>
|
|
|
|
inline float computeVolume(const T& a,const T& b,const T& c,const T& d)
|
|
|
|
{
|
2002-06-16 04:57:50 +08:00
|
|
|
return fabsf(((b-c)^(a-b))*(d-b));
|
2002-06-15 20:14:42 +08:00
|
|
|
}
|
|
|
|
|
2004-08-31 21:19:30 +08:00
|
|
|
/** compute the volume of a prism. */
|
2002-06-15 20:14:42 +08:00
|
|
|
template<typename T>
|
|
|
|
inline float computeVolume(const T& f1,const T& f2,const T& f3,
|
|
|
|
const T& b1,const T& b2,const T& b3)
|
|
|
|
{
|
|
|
|
return computeVolume(f1,f2,f3,b1)+
|
|
|
|
computeVolume(b1,b2,b3,f2)+
|
|
|
|
computeVolume(b1,b3,f2,f3);
|
|
|
|
}
|
|
|
|
|
2008-11-23 19:35:43 +08:00
|
|
|
/** Convert a ascii number to a double, ignoring locale settings.*/
|
|
|
|
extern OSG_EXPORT double asciiToDouble(const char* str);
|
|
|
|
|
|
|
|
/** Convert a ascii number to a float, ignoring locale settings.*/
|
|
|
|
inline float asciiToFloat(const char* str) { return static_cast<float>(asciiToDouble(str)); }
|
|
|
|
|
2011-05-27 00:52:08 +08:00
|
|
|
/** Detect first ascii POSITIVE number in string and convert to double.*/
|
|
|
|
extern OSG_EXPORT double findAsciiToDouble(const char* str);
|
|
|
|
|
|
|
|
/** Detect first ascii POSITIVE number in string and convert to double.*/
|
|
|
|
inline float findAsciiToFloat(const char* str) { return static_cast<float>(findAsciiToDouble(str)); }
|
|
|
|
|
2002-02-03 20:33:41 +08:00
|
|
|
}
|
2001-10-04 05:44:07 +08:00
|
|
|
|
2011-05-27 00:52:08 +08:00
|
|
|
|
2001-10-04 05:44:07 +08:00
|
|
|
#endif // __OSG_MATH
|
2005-04-06 03:08:48 +08:00
|
|
|
|