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

Working three samples in bucket auto with touching low bar park

Browse Source
This commit is contained in:
robotics1
2025-01-27 15:53:21 -08:00
parent 5932d44350
commit 73c0f137ad
2 changed files with 5 additions and 4 deletions
Download Patch File Download Diff File Expand all files Collapse all files

2
TeamCode/src/main/java/org/firstinspires/ftc/teamcode/cometbots/paths/CometBotDriveV2.java
View File

@ -118,6 +118,7 @@ public class CometBotDriveV2 extends OpMode {
moveToPark(); moveToPark();
break; break;
case 99: case 99:
wrist.toTravelPosition();
break; break;
default: default:
telemetry.addLine("default"); telemetry.addLine("default");
@ -133,7 +134,6 @@ public class CometBotDriveV2 extends OpMode {
public void moveToPark() { public void moveToPark() {
if (runtime.seconds() > 26) { if (runtime.seconds() > 26) {
path6.moveToBasketPath6(follower); path6.moveToBasketPath6(follower);
wrist.toTravelPosition();
state = 99; state = 99;
} }
} }

7
TeamCode/src/main/java/org/firstinspires/ftc/teamcode/cometbots/paths/HighBasketPath6.java
View File

@ -22,9 +22,10 @@ public class HighBasketPath6 {
builder builder
.addPath( .addPath(
// Line 1 // Line 1
new BezierLine( new BezierCurve(
new Point(27.000, 128.500, Point.CARTESIAN), new Point(27.000, 128.000, Point.CARTESIAN),
new Point(104.00, 100.00, Point.CARTESIAN) new Point(80.000, 130.000, Point.CARTESIAN),
new Point(100.000, 118.000, Point.CARTESIAN)
) )
) )
.setLinearHeadingInterpolation(Math.toRadians(0), Math.toRadians(270)); .setLinearHeadingInterpolation(Math.toRadians(0), Math.toRadians(270));