SCDS/FTCRoadRunnerRobotics
7
0
Fork 0
Code Issues 2 Pull Requests Actions Packages Projects Releases Wiki Activity

Attempt to fix moving/bucket issue

Browse Source
This commit is contained in:
Carlos Rivas
2024-11-13 16:00:13 -08:00
parent 231af71507
commit 6f2e855cb1
1 changed files with 6 additions and 2 deletions
Download Patch File Download Diff File Expand all files Collapse all files

8
TeamCode/src/main/java/org/firstinspires/ftc/teamcode/cometbots/CometBotTeleopCompetition.java
View File

@ -153,6 +153,7 @@ public class CometBotTeleopCompetition {
this.follower.breakFollowing(); this.follower.breakFollowing();
fieldStates.setFieldLocation(FieldStates.FieldLocation.BUCKET); fieldStates.setFieldLocation(FieldStates.FieldLocation.BUCKET);
Actions.runBlocking(new SequentialAction( Actions.runBlocking(new SequentialAction(
new SleepAction(.5),
this.lift.toHighBucketPosition(), this.lift.toHighBucketPosition(),
new SleepAction(.5), new SleepAction(.5),
this.arm.toBucketPosition(), this.arm.toBucketPosition(),
@ -164,7 +165,8 @@ public class CometBotTeleopCompetition {
this.wrist.toFloorPosition(), this.wrist.toFloorPosition(),
new SleepAction(.5), new SleepAction(.5),
this.arm.toParkPosition(), this.arm.toParkPosition(),
this.lift.toFloorPosition() this.lift.toFloorPosition(),
new SleepAction(.5)
)); ));
fieldStates.setFieldLocation(FieldStates.FieldLocation.TRAVELING); fieldStates.setFieldLocation(FieldStates.FieldLocation.TRAVELING);
this.follower.startTeleopDrive(); this.follower.startTeleopDrive();
@ -188,6 +190,7 @@ public class CometBotTeleopCompetition {
this.follower.breakFollowing(); this.follower.breakFollowing();
fieldStates.setFieldLocation(FieldStates.FieldLocation.BUCKET); fieldStates.setFieldLocation(FieldStates.FieldLocation.BUCKET);
Actions.runBlocking(new SequentialAction( Actions.runBlocking(new SequentialAction(
new SleepAction(.5),
this.lift.toLowBucketPosition(), this.lift.toLowBucketPosition(),
new SleepAction(.5), new SleepAction(.5),
this.arm.toBucketPosition(), this.arm.toBucketPosition(),
@ -199,7 +202,8 @@ public class CometBotTeleopCompetition {
this.wrist.toFloorPosition(), this.wrist.toFloorPosition(),
new SleepAction(.5), new SleepAction(.5),
this.arm.toParkPosition(), this.arm.toParkPosition(),
this.lift.toFloorPosition() this.lift.toFloorPosition(),
new SleepAction(.5)
)); ));
fieldStates.setFieldLocation(FieldStates.FieldLocation.TRAVELING); fieldStates.setFieldLocation(FieldStates.FieldLocation.TRAVELING);
this.follower.startTeleopDrive(); this.follower.startTeleopDrive();