diff --git a/src/main/java/frc/robot/utilities/SwerveModule.java b/src/main/java/frc/robot/utilities/SwerveModule.java index b684967..6e7af98 100644 --- a/src/main/java/frc/robot/utilities/SwerveModule.java +++ b/src/main/java/frc/robot/utilities/SwerveModule.java @@ -196,12 +196,7 @@ public class SwerveModule { } public double getTurningEncoderPosition() { - return MathUtil.inputModulus( - turningRelativeEncoder.getPosition(), - 0, - 2 * Math.PI - ); - //return turningRelativeEncoder.getPosition() * (ModuleConstants.kIsEncoderInverted ? -1 : 1); + return turningRelativeEncoder.getPosition() * (ModuleConstants.kIsEncoderInverted ? -1 : 1); } public void resetEncoders() {