fix(auto): dont follow to the same point twice

FRC3636 · Sep 20, 2023 · cfea2e4 · cfea2e4
1 parent 38252bc
commit cfea2e4
Showing 1 changed file with 1 addition and 2 deletions.
diff --git a/src/main/java/frc/robot/commands/autonomous/AutoShoot.java b/src/main/java/frc/robot/commands/autonomous/AutoShoot.java
@@ -24,9 +24,8 @@ public AutoShoot(Drivetrain drivetrain, Arm arm, PoseEstimation poseEstimation,
                         this.addCommands(
                                 new FollowTrajectoryToState(drivetrain, poseEstimation, new PathPoint(shootPose.getTranslation(), shootPose.getRotation(), shootPose.getRotation(), 2), true)
                         );
-                }
+                } 
                 this.addCommands(
-                        new FollowTrajectoryToState(drivetrain, poseEstimation, new PathPoint(shootPose.getTranslation(), shootPose.getRotation(), shootPose.getRotation(), 2), true),
                         // AllianceUtils.allianceToField(new Pose2d(new Translation2d(3.76, 4.86), new Rotation2d(180)))
                         new InstantCommand(() -> arm.setTarget(Arm.State.High)),
                         new WaitCommand(0.25),