Add getters for pose in odometry classes (#1943)

wpilibj/src/main/java/edu/wpi/first/wpilibj/kinematics/DifferentialDriveOdometry.java

@@ -64,6 +64,14 @@ public class DifferentialDriveOdometry {
     m_previousAngle = poseMeters.getRotation();
   }
 
+  /**
+   * Returns the position of the robot on the field.
+   * @return The pose of the robot (x and y are in meters).
+   */
+  public Pose2d getPoseMeters() {
+    return m_poseMeters;
+  }
+
   /**
    * Updates the robot's position on the field using forward kinematics and
    * integration of the pose over time. This method takes in the current time as

wpilibj/src/main/java/edu/wpi/first/wpilibj/kinematics/MecanumDriveOdometry.java

@@ -58,6 +58,14 @@ public class MecanumDriveOdometry {
     m_previousAngle = poseMeters.getRotation();
   }
 
+  /**
+   * Returns the position of the robot on the field.
+   * @return The pose of the robot (x and y are in meters).
+   */
+  public Pose2d getPoseMeters() {
+    return m_poseMeters;
+  }
+
   /**
    * Updates the robot's position on the field using forward kinematics and
    * integration of the pose over time. This method takes in the current time as

wpilibj/src/main/java/edu/wpi/first/wpilibj/kinematics/SwerveDriveOdometry.java

@@ -58,6 +58,14 @@ public class SwerveDriveOdometry {
     m_previousAngle = pose.getRotation();
   }
 
+  /**
+   * Returns the position of the robot on the field.
+   * @return The pose of the robot (x and y are in meters).
+   */
+  public Pose2d getPoseMeters() {
+    return m_poseMeters;
+  }
+
   /**
    * Updates the robot's position on the field using forward kinematics and
    * integration of the pose over time. This method takes in the current time as