X-Git-Url: https://git.dogcows.com/gitweb?a=blobdiff_plain;f=src%2FMoof%2FMath.hh;h=eb411e06d3299d90778117bafe81b08061c343ad;hb=33842c860fe18ca8cf087905992885687434320c;hp=4e1cda8c1a25f3a4f57cffe616a56564040f45f6;hpb=493ddb59a8620b49dfa0ff62ce93395ebfd02e86;p=chaz%2Fyoink diff --git a/src/Moof/Math.hh b/src/Moof/Math.hh index 4e1cda8..eb411e0 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>, @@ -68,12 +70,27 @@ inline Vector3& demoteVector(Vector3& left, const Vector4& right) return left; } -inline Vector4& promoteVector(Vector4& left, const Vector3& right) +inline Vector2& demoteVector(Vector2& left, const Vector3& right) +{ + left[0] = right[0]; + left[1] = right[1]; + return left; +} + +inline Vector4& promoteVector(Vector4& left, const Vector3& right, Scalar extra = 1.0) { left[0] = right[0]; left[1] = right[1]; left[2] = right[2]; - left[3] = 1.0; + left[3] = extra; + return left; +} + +inline Vector3& promoteVector(Vector3& left, const Vector2& right, Scalar extra = 1.0) +{ + left[0] = right[0]; + left[1] = right[1]; + left[3] = extra; return left; } @@ -85,7 +102,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; }