diff --git a/glm/gtc/constants.hpp b/glm/gtc/constants.hpp index 76fc1eb41..a39c9bd14 100644 --- a/glm/gtc/constants.hpp +++ b/glm/gtc/constants.hpp @@ -71,6 +71,11 @@ namespace glm template GLM_FUNC_DECL genType pi(); + /// Return pi * 2. + /// @see gtc_constants + template + GLM_FUNC_DECL genType two_pi(); + /// Return square root of pi. /// @see gtc_constants template @@ -81,6 +86,11 @@ namespace glm template GLM_FUNC_DECL genType half_pi(); + /// Return pi / 2 * 3. + /// @see gtc_constants + template + GLM_FUNC_DECL genType three_over_two_pi(); + /// Return pi / 4. /// @see gtc_constants template @@ -91,11 +101,21 @@ namespace glm template GLM_FUNC_DECL genType one_over_pi(); + /// Return 1 / (pi * 2). + /// @see gtc_constants + template + GLM_FUNC_DECL genType one_over_two_pi(); + /// Return 2 / pi. /// @see gtc_constants template GLM_FUNC_DECL genType two_over_pi(); + /// Return 4 / pi. + /// @see gtc_constants + template + GLM_FUNC_DECL genType four_over_pi(); + /// Return 2 / sqrt(pi). /// @see gtc_constants template diff --git a/glm/gtc/constants.inl b/glm/gtc/constants.inl index a9ea00951..076375c79 100644 --- a/glm/gtc/constants.inl +++ b/glm/gtc/constants.inl @@ -54,6 +54,12 @@ namespace glm return genType(3.14159265358979323846264338327950288); } + template + GLM_FUNC_QUALIFIER genType two_pi() + { + return genType(6.28318530717958647692528676655900576); + } + template GLM_FUNC_QUALIFIER genType root_pi() { @@ -66,6 +72,12 @@ namespace glm return genType(1.57079632679489661923132169163975144); } + template + GLM_FUNC_QUALIFIER genType three_over_two_pi() + { + return genType(4.71238898038468985769396507491925432); + } + template GLM_FUNC_QUALIFIER genType quarter_pi() { @@ -78,12 +90,24 @@ namespace glm return genType(0.318309886183790671537767526745028724); } + template + GLM_FUNC_QUALIFIER genType one_over_two_pi() + { + return genType(0.159154943091895335768883763372514362); + } + template GLM_FUNC_QUALIFIER genType two_over_pi() { return genType(0.636619772367581343075535053490057448); } + template + GLM_FUNC_QUALIFIER genType four_over_pi() + { + return genType(1.273239544735162686151070106980114898); + } + template GLM_FUNC_QUALIFIER genType two_over_root_pi() { diff --git a/glm/gtx/fast_trigonometry.hpp b/glm/gtx/fast_trigonometry.hpp index f89a6df6d..17b04cfbf 100644 --- a/glm/gtx/fast_trigonometry.hpp +++ b/glm/gtx/fast_trigonometry.hpp @@ -39,6 +39,7 @@ // Dependency: #include "../glm.hpp" +#include "../gtc/constants.hpp" #if(defined(GLM_MESSAGES) && !defined(GLM_EXT_INCLUDED)) # pragma message("GLM: GLM_GTX_fast_trigonometry extension included") @@ -49,14 +50,17 @@ namespace glm /// @addtogroup gtx_fast_trigonometry /// @{ - //! Faster than the common sin function but less accurate. - //! Defined between -2pi and 2pi. + //! Wrap an angle to [0 2pi[ //! From GLM_GTX_fast_trigonometry extension. template + GLM_FUNC_DECL T wrapAngle(const T& angle); + + //! Faster than the common sin function but less accurate. + //! From GLM_GTX_fast_trigonometry extension. + template GLM_FUNC_DECL T fastSin(const T& angle); //! Faster than the common cos function but less accurate. - //! Defined between -2pi and 2pi. //! From GLM_GTX_fast_trigonometry extension. template GLM_FUNC_DECL T fastCos(const T& angle); diff --git a/glm/gtx/fast_trigonometry.inl b/glm/gtx/fast_trigonometry.inl index b68e8fd56..b22487d5e 100644 --- a/glm/gtx/fast_trigonometry.inl +++ b/glm/gtx/fast_trigonometry.inl @@ -9,24 +9,45 @@ namespace glm { - // sin - template - GLM_FUNC_QUALIFIER T fastSin(T const & x) + template + GLM_FUNC_QUALIFIER T wrapAngle(T const & angle) { - return x - ((x * x * x) / T(6)) + ((x * x * x * x * x) / T(120)) - ((x * x * x * x * x * x * x) / T(5040)); + return abs(mod(angle, two_pi())); } - VECTORIZE_VEC(fastSin) + VECTORIZE_VEC(wrapAngle) + + template + GLM_FUNC_QUALIFIER T cos_52s(T const & x) + { + T const xx(x * x); + return (T(0.9999932946) + xx * (T(-0.4999124376) + xx * (T(0.0414877472) + xx * T(-0.0012712095)))); + } + + VECTORIZE_VEC(cos_52s) // cos template GLM_FUNC_QUALIFIER T fastCos(T const & x) { - return T(1) - (x * x * T(0.5)) + (x * x * x * x * T(0.041666666666)) - (x * x * x * x * x * x * T(0.00138888888888)); + T const angle(wrapAngle(x)); + if(angle()) return cos_52s(angle); + if(angle()) return -cos_52s(pi() - angle); + if(angle<(T(3) * half_pi())) return -cos_52s(angle - pi()); + return cos_52s(two_pi() - angle); } VECTORIZE_VEC(fastCos) + // sin + template + GLM_FUNC_QUALIFIER T fastSin(T const & x) + { + return fastCos(half_pi() - x); + } + + VECTORIZE_VEC(fastSin) + // tan template GLM_FUNC_QUALIFIER T fastTan(T const & x)