Add ClampMagnitude

Vector2.cpp

@@ -63,6 +63,15 @@ Vector2 Vector2::normalized() const {
   return result;
 }
 
+Vector2 Vector2::ClampMagnitude(const Vector2 &v, float magnitude) {
+  float length = Vector2::Magnitude(v);
+  Vector2 r = v;
+  if (length > magnitude)
+    r = v / (length * magnitude);
+
+  return r;
+}
+
 Vector2 Vector2::operator-(const Vector2 &v2) const {
   return Vector2(this->x - v2.x, this->y - v2.y);
 }
@@ -81,7 +90,7 @@ Vector2 Vector2::operator*(float f) const {
   return Vector2(this->x * f, this->y * f);
 }
 
-Vector2 Vector2::operator/(const float &d) {
+Vector2 Vector2::operator/(const float &d) const {
   return Vector2(this->x / d, this->y / d);
 }
 

Vector2.h

@@ -121,6 +121,8 @@ public:
   /// <returns>The vector with length 1</returns>
   Vector2 normalized() const;
 
+  static Vector2 ClampMagnitude(const Vector2 &v, float magnitude);
+
   /// <summary>
   /// Negate the vector
   /// </summary>
@@ -163,7 +165,7 @@ public:
   /// <param name="factor">The scaling factor</param>
   /// <returns>The scaled vector</returns>
   /// Each componet of the vector will be divided by the same factor.
-	Vector2 operator/(const float& factor);
+  Vector2 operator/(const float &factor) const;
 
   /// <summary>
   /// The dot product of two vectors