This commit is contained in:
Aarav Shah
2021-03-29 17:13:47 -06:00
parent 05f8eb14b1
commit d470e37239
@@ -338,7 +338,7 @@ public class Drive extends SubsystemBase {
public void updateOdometry(boolean reversed){
if (reversed){
m_odometry.update(Rotation2d.fromDegrees( getHeading()),
m_odometry.update(Rotation2d.fromDegrees( -getHeading()-180),
-inchesToMeters(getDistanceInches(m_rightFrontMotor)),
inchesToMeters(getDistanceInches(m_leftFrontMotor)));
}