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

Merge remote-tracking branch 'origin/branch-rc-chassis-14493' into branch-rc-chassis-14493

Browse Source
This commit is contained in:
robotics2
2024-10-24 16:54:09 -07:00
parent f7aa0c4319 308f301bd5
commit 1f7b3467c1
1 changed files with 14 additions and 5 deletions
Download Patch File Download Diff File Expand all files Collapse all files

19
TeamCode/src/main/java/org/firstinspires/ftc/teamcode/AutoExampleThree.java
View File

@ -34,7 +34,7 @@ public class AutoExampleThree extends OpMode {
private PathChain path; private PathChain path;
private final Pose startPose = new Pose(10.0, 40, 90); private final Pose startPose = new Pose(7.467869222096955, 59.74295377677565);
/** /**
* This initializes the Follower and creates the PathChain for the "circle". Additionally, this * This initializes the Follower and creates the PathChain for the "circle". Additionally, this
@ -52,12 +52,21 @@ public class AutoExampleThree extends OpMode {
.addPath( .addPath(
// Line 1 // Line 1
new BezierCurve( new BezierCurve(
new Point(10.000, 20.000, Point.CARTESIAN), new Point(7.468, 59.743, Point.CARTESIAN),
new Point(29.089, 61.232, Point.CARTESIAN), new Point(67.860, 12.014, Point.CARTESIAN),
new Point(48.054, 19.607, Point.CARTESIAN) new Point(101.790, 36.041, Point.CARTESIAN),
new Point(68.347, 22.891, Point.CARTESIAN)
) )
) )
.setConstantHeadingInterpolation(Math.toRadians(90)).build(); .setTangentHeadingInterpolation()
.addPath(
// Line 2
new BezierLine(
new Point(68.347, 22.891, Point.CARTESIAN),
new Point(13.637, 24.352, Point.CARTESIAN)
)
)
.setTangentHeadingInterpolation().build();
follower.followPath(path); follower.followPath(path);