X-Git-Url: https://git.dogcows.com/gitweb?a=blobdiff_plain;f=src%2FMoof%2FMath.hh;h=6665a195bc0341f0acb629d4e036bea95efd0c19;hb=64bd443538f57ad1bdff6c6b35953e72141129b2;hp=c4e3484ebebc56b5bad7e05cee6c13f9ef657557;hpb=16d1a05b0777e97a45c48e2874aa4e5cc791282e;p=chaz%2Fyoink diff --git a/src/Moof/Math.hh b/src/Moof/Math.hh index c4e3484..6665a19 100644 --- a/src/Moof/Math.hh +++ b/src/Moof/Math.hh @@ -49,6 +49,8 @@ typedef cml::vector< Scalar, cml::fixed<2> > Vector2; typedef cml::vector< Scalar, cml::fixed<3> > Vector3; typedef cml::vector< Scalar, cml::fixed<4> > Vector4; +typedef cml::matrix< Scalar, cml::fixed<2,2>, + cml::col_basis, cml::col_major > Matrix2; typedef cml::matrix< Scalar, cml::fixed<3,3>, cml::col_basis, cml::col_major > Matrix3; typedef cml::matrix< Scalar, cml::fixed<4,4>, @@ -57,6 +59,30 @@ typedef cml::matrix< Scalar, cml::fixed<4,4>, typedef cml::quaternion< Scalar, cml::fixed<>, cml::vector_first, cml::positive_cross > Quaternion; +typedef cml::constants Constants; + + +inline Vector3 demote(const Vector4& vec) +{ + return Vector3(vec[0], vec[1], vec[2]); +} + +inline Vector2 demote(const Vector3& vec) +{ + return Vector2(vec[0], vec[1]); +} + +inline Vector4 promote(const Vector3& vec, Scalar extra = 1.0) +{ + return Vector4(vec[0], vec[1], vec[2], extra); +} + +inline Vector3 promote(const Vector2& vec, Scalar extra = 1.0) +{ + return Vector3(vec[0], vec[1], extra); +} + + const Scalar EPSILON = 0.000001; @@ -64,7 +90,7 @@ const Scalar EPSILON = 0.000001; * Check the equality of scalars with a certain degree of error allowed. */ -inline bool checkEquality(Scalar a, Scalar b, Scalar epsilon = EPSILON) +inline bool isEqual(Scalar a, Scalar b, Scalar epsilon = EPSILON) { return std::abs(a - b) < epsilon; }