diff --git a/src/main/java/swervelib/SwerveInputStream.java b/src/main/java/swervelib/SwerveInputStream.java index ddb4c51be..2c29fc01c 100644 --- a/src/main/java/swervelib/SwerveInputStream.java +++ b/src/main/java/swervelib/SwerveInputStream.java @@ -831,6 +831,12 @@ public ChassisSpeeds get() .getAsDouble(), controllerHeadingY.get() .getAsDouble())))).getRadians()); + + // Prevent rotation if controller heading inputs are not past axisDeadband + if(Math.abs(controllerHeadingX.get().getAsDouble())+Math.abs(controllerHeadingY.get().getAsDouble()) < axisDeadband.get()) { + omegaRadiansPerSecond = 0; + } + speeds = new ChassisSpeeds(vxMetersPerSecond, vyMetersPerSecond, omegaRadiansPerSecond); break; }