Change andThen to a finallyDo so the interrupt is disabled when t…

…he command group is interrupted

src/main/java/frc/robot/subsystems/Head.java

@@ -119,7 +119,7 @@ public Command IntakePiece() {
 			intakeInterrupt.enable();
 		}, this)
 				.andThen(Commands.waitUntil(() -> isNoteWithinSensor()))
-				.andThen(() -> {
+				.finallyDo(() -> {
 					intakeInterrupt.disable();
 				});
 	}