[MathLib] Vector3: Impl. and test for normalization.

MathLib/Vector3.h

@@ -127,6 +127,16 @@ public:
 		return *this;
 	}
 
+	/**
+	 * After applying the normalize operator to the vector its length is 1.0.
+	 */
+	void normalize()
+	{
+		const double s(1/length());
+		for (std::size_t i(0); i < 3; i++)
+			this->_x[i] *= s;
+	}
+
 	/// Returns the length
 	double length(void) const
 	{

Tests/MathLib/TestVector3.cpp

@@ -155,5 +155,10 @@ TEST(MathLib, TestVector3Multiplications)
 	ASSERT_NEAR(1.0, v[0], std::numeric_limits<double>::epsilon());
 	ASSERT_NEAR(3.0, v[1], std::numeric_limits<double>::epsilon());
 	ASSERT_NEAR(5.0, v[2], std::numeric_limits<double>::epsilon());
+
+	// test normalisation
+	v.normalize();
+	ASSERT_NEAR(1.0, v.length(), std::numeric_limits<double>::epsilon());
+
 }