Attempt to fix moving/bucket issue
This commit is contained in:
@ -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();
|
||||
|
Reference in New Issue
Block a user