Basket Auto code

This commit is contained in:
robotics1
2024-12-12 17:30:06 -08:00
parent 1bf475772c
commit f80026465b
2 changed files with 6 additions and 6 deletions

View File

@ -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() {

View File

@ -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);