Whatever is left at the end of LM1
This commit is contained in:
parent
514b02acd4
commit
61f589b000
|
@ -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();
|
||||
|
|
|
@ -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())
|
||||
|
|
Loading…
Reference in New Issue