Added normalize function to MathVector