Whatever is left at the end of LM1

This commit is contained in:
sihan 2023-11-11 20:13:23 -06:00
parent 514b02acd4
commit 61f589b000
2 changed files with 6 additions and 6 deletions

View File

@ -54,11 +54,11 @@ public class Auto extends LinearOpMode {
.build();
this.scoreOne = this.robot.getDrive().trajectoryBuilder(preloadOne.end())
.lineToLinearHeading(new Pose2d(33, -30, Math.toRadians(360)))
.lineToLinearHeading(new Pose2d(31, -32, Math.toRadians(360)))
.build();
this.boardOne = this.robot.getDrive().trajectoryBuilder(scoreOne.end())
.lineToLinearHeading(new Pose2d(73, -26, Math.toRadians(360)))
.lineToLinearHeading(new Pose2d(73, -28, Math.toRadians(360)))
.addTemporalMarker(.2, robot.getArm()::armAccurateScore)
.addTemporalMarker(.2, robot.getWrist()::wristScore)
.build();
@ -70,11 +70,11 @@ public class Auto extends LinearOpMode {
//Randomization Two
this.preloadTwo = this.robot.getDrive().trajectoryBuilder(initialPosition)
.lineToLinearHeading(new Pose2d(35, -27, Math.toRadians(270)))
.lineToLinearHeading(new Pose2d(35, -28, Math.toRadians(270)))
.build();
this.scoreTwo = this.robot.getDrive().trajectoryBuilder(preloadTwo.end())
.lineToLinearHeading(new Pose2d(73, -34, Math.toRadians(360)))
.lineToLinearHeading(new Pose2d(73, -34.5, Math.toRadians(360)))
.addTemporalMarker(.2, robot.getArm()::armAccurateScore)
.addTemporalMarker(.2, robot.getWrist()::wristScore)
.build();

View File

@ -53,7 +53,7 @@ public class AutoBlue extends LinearOpMode {
.build();
this.scoreOne = this.robot.getDrive().trajectoryBuilder(preloadOne.end())
.lineToLinearHeading(new Pose2d(-29, -30, Math.toRadians(180)))
.lineToLinearHeading(new Pose2d(-29, -32, Math.toRadians(180)))
.build();
this.boardOne = this.robot.getDrive().trajectoryBuilder(scoreOne.end())
@ -69,7 +69,7 @@ public class AutoBlue extends LinearOpMode {
//Randomization Two
this.preloadTwo = this.robot.getDrive().trajectoryBuilder(initialPosition)
.lineToLinearHeading(new Pose2d(-35, -27, Math.toRadians(270)))
.lineToLinearHeading(new Pose2d(-35, -28, Math.toRadians(270)))
.build();
this.scoreTwo = this.robot.getDrive().trajectoryBuilder(preloadTwo.end())