ODOMETRY MIGHT WORK (more testing needed tho)

src/main/java/frc4388/robot/RobotContainer.java

@@ -5,6 +5,7 @@
 package frc4388.robot;
 
 
+import edu.wpi.first.math.geometry.Pose2d;
 import edu.wpi.first.wpilibj.Joystick;
 import edu.wpi.first.wpilibj2.command.Command;
 import edu.wpi.first.wpilibj2.command.InstantCommand;
@@ -116,6 +117,9 @@ public class RobotContainer {
     return m_driverXbox;
   }
 
+  public Pose2d getOdometry() {
+    return m_robotSwerveDrive.getOdometry();
+  }
   /**
    * Add your docs here.
    */