diff --git a/src/main/java/frc/robot/autoalign/MovingAutoAlign.java b/src/main/java/frc/robot/autoalign/MovingAutoAlign.java index c2617a6..8e83259 100644 --- a/src/main/java/frc/robot/autoalign/MovingAutoAlign.java +++ b/src/main/java/frc/robot/autoalign/MovingAutoAlign.java @@ -81,7 +81,8 @@ public static Command moveToPoseUntilInTolerances( Supplier speedsModifier, Supplier xyConstraints) { return moveToPose(swerve, target, speedsModifier, xyConstraints) - .until(() -> AutoAlignUtils.isInTolerance(swerve.getState().Pose, target.get(), swerve.getState().Speeds)); + .until(() -> AutoAlignUtils.isInTolerance(swerve.getState().Pose, target.get())) + .andThen(swerve.stopCmd()); } /**