beginning CD implementation

[chaz/yoink] / src / Moof / Math.hh

diff --git a/src/Moof/Math.hh b/src/Moof/Math.hh
index a38af8b049dd77357c175aa79ecb2c5d5969c810..6665a195bc0341f0acb629d4e036bea95efd0c19 100644 (file)
--- 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>,
@@ -60,36 +62,24 @@ typedef cml::quaternion< Scalar, cml::fixed<>, cml::vector_first,
 typedef cml::constants<Scalar>                                 Constants;
 
 
-inline Vector3& demoteVector(Vector3& left, const Vector4& right)
+inline Vector3 demote(const Vector4& vec)
 {
-       left[0] = right[0];
-       left[1] = right[1];
-       left[2] = right[2];
-       return left;
+       return Vector3(vec[0], vec[1], vec[2]);
 }
 
-inline Vector2& demoteVector(Vector2& left, const Vector3& right)
+inline Vector2 demote(const Vector3& vec)
 {
-       left[0] = right[0];
-       left[1] = right[1];
-       return left;
+       return Vector2(vec[0], vec[1]);
 }
 
-inline Vector4& promoteVector(Vector4& left, const Vector3& right, Scalar extra = 1.0)
+inline Vector4 promote(const Vector3& vec, Scalar extra = 1.0)
 {
-       left[0] = right[0];
-       left[1] = right[1];
-       left[2] = right[2];
-       left[3] = extra;
-       return left;
+       return Vector4(vec[0], vec[1], vec[2], extra);
 }
 
-inline Vector3& promoteVector(Vector3& left, const Vector2& right, Scalar extra = 1.0)
+inline Vector3 promote(const Vector2& vec, Scalar extra = 1.0)
 {
-       left[0] = right[0];
-       left[1] = right[1];
-       left[3] = extra;
-       return left;
+       return Vector3(vec[0], vec[1], extra);
 }