Climber auto

src/main/java/frc4388/utility/Vector2D.java

@@ -58,6 +58,15 @@ public class Vector2D extends Vector2d {
     return new Vector2D(v1.x + v2.x, v1.y + v2.y);
   }
 
+  /**
+   * Adds vector to current object
+   * @param v Vector to add
+   */
+  public void add(Vector2D v) {
+    x += v.x;
+    y += v.x;
+  }
+
   /**
    * Subtract two vectors, component-wise.
    * @param v1 First vector in the subtraction.
@@ -68,6 +77,15 @@ public class Vector2D extends Vector2d {
     return new Vector2D(v1.x - v2.x, v1.y - v2.y);
   }
 
+  /**
+   * Subtracts vector from current object
+   * @param v Vector to subtract
+   */
+  public void subtract(Vector2D v) {
+    x -= v.x;
+    y -= v.x;
+  }
+
   /**
    * Multiply a vector with a scalar, component-wise.
    * @param v1 Vector to multiply.
@@ -78,6 +96,15 @@ public class Vector2D extends Vector2d {
     return new Vector2D(scalar * v1.x, scalar * v1.y);
   }
 
+  /**
+   * Multiply a vector with a scalar, component-wise.
+   * @param scalar Scalar to multiply
+   */
+  public void multiply(double scalar) {
+    x *= scalar;
+    y *= scalar;
+  }
+
     /**
    * Divide a vector with a scalar, component-wise.
    * @param v1 Vector to divide.
@@ -88,6 +115,15 @@ public class Vector2D extends Vector2d {
     return new Vector2D(v1.x / scalar, v1.y / scalar);
   }
 
+  /**
+   * Divide a vector with a scalar, component-wise.
+   * @param scalar Scalar to divide
+   */
+  public void divide(double scalar) {
+    x /= scalar;
+    y /= scalar;
+  }
+
   /**
    * Find unit vector.
    * @return The unit vector.