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

Changes that covered the hang and wrist touching bar during auto

Browse Source
This commit is contained in:
carlos
2025-02-06 16:50:13 -08:00
parent 47facdde5e
commit 2974904109
4 changed files with 33 additions and 25 deletions
Download Patch File Download Diff File Expand all files Collapse all files

38
TeamCode/src/main/java/org/firstinspires/ftc/teamcode/SpecimenAuto.java
View File

@ -43,6 +43,7 @@ public class SpecimenAuto extends OpMode {
wrist.InitAuto();
arm.initAuto();
follower.setMaxPower(.45);
@ -50,42 +51,49 @@ public class SpecimenAuto extends OpMode {
@Override
public void loop() {
if(runtime != null){
telemetry.addData("Runtime (seconds)", runtime.seconds());
}
telemetry.addData("state", state);
switch(state) {
case 0:
runtime.reset();
wrist.toSpecimenPrep();
arm.toSpecimenPrep();
state = 1;
new SleepAction(5);
if(runtime.seconds() > 0.25){state = 1;}
break;
case 1:
state = 2;
//line 1
if(runtime.seconds() > 3){state = 2;}
break;
case 2:
new SleepAction(5);
state = 3;
lift.toSpecimanHangHeight();
if(runtime.seconds() > 3.75){state = 3;}
break;
case 3:
new SleepAction(5);
state = 4;
wrist.toSpecimenHang();
if(runtime.seconds() > 4){state = 4;}
break;
case 4:
new SleepAction(5);
state = 5;
lift.toSpecimanReleaseHeight();
if(runtime.seconds() > 4.5){state = 5;}
break;
case 5:
//specimen drop
claw.switchState();
if(runtime.seconds() > 4.65){state = 6;}
break;
case 6:
//path 4
lift.toFloorPosition();
if(runtime.seconds() > 4.75){state = 7;}
break;
case 7:
//specimen pick up
arm.toParkPosition();
wrist.toTravelPosition();
//line 2
if(runtime.seconds() > 0.){state = 8;}
break;
case 8:
//path 5
if(runtime.seconds() > 0.25){state = 9;}
break;
case 9:
//specimen drop

14
TeamCode/src/main/java/org/firstinspires/ftc/teamcode/SpecimenAutoLineTest.java
View File

@ -13,7 +13,7 @@ import org.firstinspires.ftc.teamcode.pedroPathing.pathGeneration.BezierLine;
import org.firstinspires.ftc.teamcode.pedroPathing.pathGeneration.PathChain;
import org.firstinspires.ftc.teamcode.pedroPathing.pathGeneration.Point;
@Autonomous(name = "Specimen Test", group = "Competition")
@Autonomous(name = "Specimen Line Test", group = "Competition")
public class SpecimenAutoLineTest extends OpMode {
private Telemetry telemetryA;
@ -40,15 +40,15 @@ public class SpecimenAutoLineTest extends OpMode {
new Point(39.500, 60.000, Point.CARTESIAN)
)
)
.setLinearHeadingInterpolation(Math.toRadians(0), Math.toRadians(180))
/* .addPath(
.setLinearHeadingInterpolation(Math.toRadians(0), Math.toRadians(0))
.addPath(
// Line 2
new BezierLine(
new Point(39.500, 60.000, Point.CARTESIAN),
new Point(37.000, 60.000, Point.CARTESIAN)
)
)
.setConstantHeadingInterpolation(Math.toRadians(180))
.setConstantHeadingInterpolation(Math.toRadians(0))
.addPath(
// Line 3
new BezierCurve(
@ -58,7 +58,7 @@ public class SpecimenAutoLineTest extends OpMode {
new Point(58.000, 23.500, Point.CARTESIAN)
)
)
.setConstantHeadingInterpolation(Math.toRadians(180))
.setConstantHeadingInterpolation(Math.toRadians(0))
.addPath(
// Line 4
new BezierLine(
@ -66,7 +66,7 @@ public class SpecimenAutoLineTest extends OpMode {
new Point(14.000, 23.500, Point.CARTESIAN)
)
)
.setConstantHeadingInterpolation(Math.toRadians(180))
.setConstantHeadingInterpolation(Math.toRadians(0))
.addPath(
// Line 5
new BezierLine(
@ -155,7 +155,7 @@ public class SpecimenAutoLineTest extends OpMode {
new Point(37.000, 68.000, Point.CARTESIAN)
)
)
.setConstantHeadingInterpolation(Math.toRadians(180))*/.build();
.setConstantHeadingInterpolation(Math.toRadians(180)).build();
follower.followPath(path);
telemetryA = new MultipleTelemetry(this.telemetry, FtcDashboard.getInstance().getTelemetry());

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

@ -118,7 +118,7 @@ public class CometBotDriveV2 extends OpMode {
moveToPark();
break;
case 99:
wrist.toTravelPosition();
wrist.toFloorPosition();
break;
default:
telemetry.addLine("default");

4
TeamCode/src/main/java/org/firstinspires/ftc/teamcode/subsystems/HangMotorSubsystem.java
View File

@ -22,10 +22,10 @@ public class HangMotorSubsystem {
}
public void init(){
//init hook, set runmodes
hang.setMode(DcMotor.RunMode.STOP_AND_RESET_ENCODER);
//hang.setMode(DcMotor.RunMode.STOP_AND_RESET_ENCODER);
hang.setDirection(DcMotorSimple.Direction.FORWARD);
hang.setZeroPowerBehavior(DcMotor.ZeroPowerBehavior.BRAKE);
hang.setMode(DcMotor.RunMode.RUN_USING_ENCODER);
hang.setMode(DcMotor.RunMode.RUN_WITHOUT_ENCODER);
}
public void hangRobot(){