Goog
This commit is contained in:
parent
dbf6d85e9f
commit
277d9d55cc
|
@ -67,6 +67,9 @@ public class AutoRed extends LinearOpMode {
|
||||||
builder.addTemporalMarker(.2, robot.getSlides()::slideFirstLayer);
|
builder.addTemporalMarker(.2, robot.getSlides()::slideFirstLayer);
|
||||||
builder.addTemporalMarker(.2, robot.getWrist()::wristScore);
|
builder.addTemporalMarker(.2, robot.getWrist()::wristScore);
|
||||||
this.robot.getDrive().followTrajectorySequence(builder.build());
|
this.robot.getDrive().followTrajectorySequence(builder.build());
|
||||||
|
while (this.robot.getDrive().isBusy()) {
|
||||||
|
robot.update();
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
protected void park() {
|
protected void park() {
|
||||||
|
@ -85,6 +88,9 @@ public class AutoRed extends LinearOpMode {
|
||||||
builder.addTemporalMarker(.1, robot.getWrist()::wristPickup);
|
builder.addTemporalMarker(.1, robot.getWrist()::wristPickup);
|
||||||
builder.addTemporalMarker(.1, robot.getSlides()::slideDown);
|
builder.addTemporalMarker(.1, robot.getSlides()::slideDown);
|
||||||
this.robot.getDrive().followTrajectorySequence(builder.build());
|
this.robot.getDrive().followTrajectorySequence(builder.build());
|
||||||
|
while (this.robot.getDrive().isBusy()) {
|
||||||
|
robot.update();
|
||||||
|
}
|
||||||
}
|
}
|
||||||
|
|
||||||
protected void parkLocation(){
|
protected void parkLocation(){
|
||||||
|
@ -112,7 +118,6 @@ public class AutoRed extends LinearOpMode {
|
||||||
this.telemetry.addData("Park Position", parkLocation);
|
this.telemetry.addData("Park Position", parkLocation);
|
||||||
this.telemetry.update();
|
this.telemetry.update();
|
||||||
}
|
}
|
||||||
while (!isStopRequested()) {
|
|
||||||
robot.update();
|
robot.update();
|
||||||
scorePreloadOne();
|
scorePreloadOne();
|
||||||
boardScore();
|
boardScore();
|
||||||
|
@ -120,8 +125,6 @@ public class AutoRed extends LinearOpMode {
|
||||||
this.robot.getClaw().open();
|
this.robot.getClaw().open();
|
||||||
sleep(250);
|
sleep(250);
|
||||||
park();
|
park();
|
||||||
stop();
|
|
||||||
}
|
|
||||||
}
|
}
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
Loading…
Reference in New Issue