Basket Auto code
This commit is contained in:
@ -20,7 +20,7 @@ public class BlueBasketAutoWithDrop1 extends OpMode {
|
|||||||
|
|
||||||
private PathChain path;
|
private PathChain path;
|
||||||
|
|
||||||
private final Pose startPose = new Pose(8, 65);
|
private final Pose startPose = new Pose(8, 89);
|
||||||
|
|
||||||
@Override
|
@Override
|
||||||
public void init() {
|
public void init() {
|
||||||
|
@ -20,7 +20,7 @@ public class BlueBasketAutoWithDrop2 extends OpMode {
|
|||||||
|
|
||||||
private PathChain path;
|
private PathChain path;
|
||||||
|
|
||||||
private final Pose startPose = new Pose(8, 65);
|
private final Pose startPose = new Pose(16, 128);
|
||||||
|
|
||||||
@Override
|
@Override
|
||||||
public void init() {
|
public void init() {
|
||||||
@ -33,14 +33,14 @@ public class BlueBasketAutoWithDrop2 extends OpMode {
|
|||||||
path = follower.pathBuilder()
|
path = follower.pathBuilder()
|
||||||
|
|
||||||
.addPath(
|
.addPath(
|
||||||
// Line 2
|
// Line 1
|
||||||
new BezierCurve(
|
new BezierCurve(
|
||||||
new Point(16.000, 128.000, Point.CARTESIAN),
|
new Point(16.000, 128.000, Point.CARTESIAN),
|
||||||
new Point(16.000, 120.000, Point.CARTESIAN),
|
new Point(88.000, 140.000, Point.CARTESIAN),
|
||||||
new Point(32.000, 123.000, Point.CARTESIAN)
|
new Point(83.250, 99.000, Point.CARTESIAN)
|
||||||
)
|
)
|
||||||
)
|
)
|
||||||
.setLinearHeadingInterpolation(Math.toRadians(135), Math.toRadians(0)).build();
|
.setLinearHeadingInterpolation(Math.toRadians(135), Math.toRadians(270)).build();
|
||||||
|
|
||||||
follower.followPath(path);
|
follower.followPath(path);
|
||||||
|
|
||||||
|
Reference in New Issue
Block a user