Add missing methods to rotation PID controler

src/main/java/org/lasarobotics/drive/RotatePIDController.java

@@ -59,7 +59,7 @@ public RotatePIDController(PolynomialSplineFunction rotateInputCurve, PIDConstan
   }
 
   /**
-   * Returns next output of RotatePIDController
+   * Returns next output of rotation PID controller
    * @param currentAngle current yaw angle of robot
    * @param rotateRate current yaw rotate rate of robot
    * @param rotateRequest rotate request [-1.0, +1.0]
@@ -89,6 +89,21 @@ public Measure<Velocity<Angle>> calculate(Measure<Angle> currentAngle, Measure<V
     return Units.DegreesPerSecond.of(m_pidController.calculate(currentAngle.in(Units.Degrees)));
   }
 
+  /**
+   * Set setpoint of rotation PID controller
+   * @param angle
+   */
+  public void setSetpoint(Measure<Angle> angle) {
+    m_pidController.setSetpoint(angle.in(Units.Degrees));
+  }
+
+  /**
+   * Reset rotation PID controller
+   */
+  public void reset() {
+    m_pidController.reset();
+  }
+
   /**
    * Get if robot is rotating
    * @return True if rotating