Adjusted placement of vision function.

Signed-off-by: thenetworkgrinch <thenetworkgrinch@users.noreply.github.com>

src/main/java/frc/robot/subsystems/swervedrive/SwerveSubsystem.java

@@ -123,6 +123,17 @@ public void updatePoseWithVision()
     vision.updatePoseEstimation(swerveDrive);
   }
 
+  /**
+   * Get the pose while updating with vision readings.
+   *
+   * @return The robots pose with the vision estimates in place.
+   */
+  public Pose2d getVisionPose()
+  {
+    vision.updatePoseEstimation(swerveDrive);
+    return swerveDrive.getPose();
+  }
+
   /**
    * Setup AutoBuilder for PathPlanner.
    */
@@ -439,17 +450,6 @@ public Pose2d getPose()
     return swerveDrive.getPose();
   }
 
-  /**
-   * Get the pose while updating with vision readings.
-   *
-   * @return The robots pose with the vision estimates in place.
-   */
-  public Pose2d getVisionPose()
-  {
-    vision.updatePoseEstimation(swerveDrive);
-    return swerveDrive.getPose();
-  }
-
   /**
    * Set chassis speeds with closed-loop velocity control.
    *