SCDS/FTCRoadRunnerRobotics
7
0
Fork 0
Code Issues 2 Pull Requests Actions Packages Projects Releases Wiki Activity

Basket Auto code

Browse Source
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
Download Patch File Download Diff File Expand all files Collapse all files

2
TeamCode/src/main/java/org/firstinspires/ftc/teamcode/BlueBasketAutoWithDrop1.java
View File

@ -20,7 +20,7 @@ public class BlueBasketAutoWithDrop1 extends OpMode {
private PathChain path;
private final Pose startPose = new Pose(8, 65);
private final Pose startPose = new Pose(8, 89);
@Override
public void init() {

10
TeamCode/src/main/java/org/firstinspires/ftc/teamcode/BlueBasketAutoWithDrop2.java
View File

@ -20,7 +20,7 @@ public class BlueBasketAutoWithDrop2 extends OpMode {
private PathChain path;
private final Pose startPose = new Pose(8, 65);
private final Pose startPose = new Pose(16, 128);
@Override
public void init() {
@ -33,14 +33,14 @@ public class BlueBasketAutoWithDrop2 extends OpMode {
path = follower.pathBuilder()
.addPath(
// Line 2
// Line 1
new BezierCurve(
new Point(16.000, 128.000, Point.CARTESIAN),
new Point(16.000, 120.000, Point.CARTESIAN),
new Point(32.000, 123.000, Point.CARTESIAN)
new Point(88.000, 140.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);