From ed02ee788a8b47264405f16b0962169a38173bac Mon Sep 17 00:00:00 2001 From: T Grinch <10247070+thenetworkgrinch@users.noreply.github.com> Date: Fri, 14 Jun 2024 12:56:52 -0500 Subject: [PATCH] Reverted changes. Signed-off-by: thenetworkgrinch --- src/main/java/swervelib/SwerveDrive.java | 3 +-- 1 file changed, 1 insertion(+), 2 deletions(-) diff --git a/src/main/java/swervelib/SwerveDrive.java b/src/main/java/swervelib/SwerveDrive.java index 1bd7b0b4..9f45b916 100644 --- a/src/main/java/swervelib/SwerveDrive.java +++ b/src/main/java/swervelib/SwerveDrive.java @@ -666,8 +666,7 @@ public ChassisSpeeds getRobotVelocity() public void resetOdometry(Pose2d pose) { odometryLock.lock(); - SwerveModulePosition[] positions = getModulePositions(); - swerveDrivePoseEstimator.resetPosition(getYaw(), positions, pose); + swerveDrivePoseEstimator.resetPosition(getYaw(), getModulePositions(), pose); odometryLock.unlock(); kinematics.toSwerveModuleStates(ChassisSpeeds.fromFieldRelativeSpeeds(0, 0, 0, getYaw())); }