From f197c40d99a246f87dac98a50ac1f74343495532 Mon Sep 17 00:00:00 2001
From: Tyler Veness <calcmogul@gmail.com>
Date: Mon, 14 Oct 2024 11:45:53 -0700
Subject: [PATCH] [wpimath] Remove dead code from C++
 PoseEstimator.GetEstimatedPosition()

This also makes it match Java.
---
 .../src/main/native/include/frc/estimator/PoseEstimator.inc  | 5 -----
 1 file changed, 5 deletions(-)

diff --git a/wpimath/src/main/native/include/frc/estimator/PoseEstimator.inc b/wpimath/src/main/native/include/frc/estimator/PoseEstimator.inc
index 51bb8343062..b83652302c3 100644
--- a/wpimath/src/main/native/include/frc/estimator/PoseEstimator.inc
+++ b/wpimath/src/main/native/include/frc/estimator/PoseEstimator.inc
@@ -79,11 +79,6 @@ template <typename WheelSpeeds, typename WheelPositions>
 Pose2d PoseEstimator<WheelSpeeds, WheelPositions>::GetEstimatedPosition()
     const {
   return m_poseEstimate;
-  if (m_visionUpdates.empty()) {
-    return m_odometry.GetPose();
-  }
-  auto visionUpdate = m_visionUpdates.rbegin()->second;
-  return visionUpdate.Compensate(m_odometry.GetPose());
 }
 
 template <typename WheelSpeeds, typename WheelPositions>