TeamCode/src/main/java/org/firstinspires/ftc/teamcode/util/RingPickupPathGenerator.java
/**
     * Utility function to calculate the position if move from current pose2d by distance
     * @param pose Current pose2d (location & Heading)
     * @param dist Distance to move
     * @return Final position
     */
Utility function to calculate the position if move from current pose2d by distance
@param pose Current pose2d (location & Heading)
@param dist Distance to move
@return Final position
Utility function to calculate the position if move from current pose2d by distance @param pose Current pose2d ( location & Heading ) @param dist Distance to move @return Final position
Vector2D move(Pose2d pose, double dist) {
        double x = pose.getX() + dist * Math.cos(pose.getHeading());
        double y = pose.getY() + dist * Math.sin(pose.getHeading());
        return new Vector2D(x, y);
    }
Vector2D move ( Pose2d pose , double dist ) { double x = pose . getX ( ) + dist * Math . cos ( pose . getHeading ( ) ) ; double y = pose . getY ( ) + dist * Math . sin ( pose . getHeading ( ) ) ; return new Vector2D ( x , y ) ; }
Utility function to calculate the position if move from current pose2d by distance
 @param pose Current pose2d (location & Heading)
 @param dist Distance to move
 @return Final position
Utility function to calculate the position if move from current pose2d by distance @param pose Current pose2d ( location & Heading ) @param dist Distance to move @return Final position