diff --git a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/cometbots/CometBotTeleopCompetition.java b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/cometbots/CometBotTeleopCompetition.java index 72eb986..e2e7758 100644 --- a/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/cometbots/CometBotTeleopCompetition.java +++ b/TeamCode/src/main/java/org/firstinspires/ftc/teamcode/cometbots/CometBotTeleopCompetition.java @@ -153,6 +153,7 @@ public class CometBotTeleopCompetition { this.follower.breakFollowing(); fieldStates.setFieldLocation(FieldStates.FieldLocation.BUCKET); Actions.runBlocking(new SequentialAction( + new SleepAction(.5), this.lift.toHighBucketPosition(), new SleepAction(.5), this.arm.toBucketPosition(), @@ -164,7 +165,8 @@ public class CometBotTeleopCompetition { this.wrist.toFloorPosition(), new SleepAction(.5), this.arm.toParkPosition(), - this.lift.toFloorPosition() + this.lift.toFloorPosition(), + new SleepAction(.5) )); fieldStates.setFieldLocation(FieldStates.FieldLocation.TRAVELING); this.follower.startTeleopDrive(); @@ -188,6 +190,7 @@ public class CometBotTeleopCompetition { this.follower.breakFollowing(); fieldStates.setFieldLocation(FieldStates.FieldLocation.BUCKET); Actions.runBlocking(new SequentialAction( + new SleepAction(.5), this.lift.toLowBucketPosition(), new SleepAction(.5), this.arm.toBucketPosition(), @@ -199,7 +202,8 @@ public class CometBotTeleopCompetition { this.wrist.toFloorPosition(), new SleepAction(.5), this.arm.toParkPosition(), - this.lift.toFloorPosition() + this.lift.toFloorPosition(), + new SleepAction(.5) )); fieldStates.setFieldLocation(FieldStates.FieldLocation.TRAVELING); this.follower.startTeleopDrive();