Scoring command finishes staging before waiting to reach pose

Author: owen-beck

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

@@ -304,13 +304,13 @@ public Command scorePlaceCommand(SuperstructureState travelState, Superstructure
             Commands.waitUntil(() -> (isNearTargetPose.get() || overrideNearPose.get())),
             Commands.runOnce(() -> setState(travelState),
                 elevator, arm, wrist, intake),
-            Commands.waitUntil(() -> ((isElevatorAtTargetPosition()) || overrideAtPose.get())),
+            Commands.waitUntil(() -> isElevatorAtTargetPosition()),
             Commands.runOnce(() -> setState(stagingState),
                 elevator, arm, wrist, intake),
-            Commands.waitUntil(() -> ((isAtTargetState() && isAtTargetPose.get()) || overrideAtPose.get())),
+            Commands.waitUntil(() -> isAtTargetState()),
             Commands.runOnce(() -> setState(secondStagingState),
                 elevator, arm, wrist, intake),
-            Commands.waitUntil(() -> isAtTargetState()),
+            Commands.waitUntil(() -> (isAtTargetState() && (isAtTargetPose.get() || overrideAtPose.get()))),
             Commands.runOnce(() -> setState(placingState),
                 elevator, arm, wrist, intake),
             Commands.waitUntil(() -> isAtTargetState()),