Working Pre loaded auto! Can score 11 points consistently!
This commit is contained in:
@ -13,6 +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.PathChain;
|
||||||
import org.firstinspires.ftc.teamcode.pedroPathing.pathGeneration.Point;
|
import org.firstinspires.ftc.teamcode.pedroPathing.pathGeneration.Point;
|
||||||
|
|
||||||
|
|
||||||
@Autonomous(name = "Pre Loaded Blue Basket Auto", group = "Competition")
|
@Autonomous(name = "Pre Loaded Blue Basket Auto", group = "Competition")
|
||||||
public class PreLoadedBlueBasketAuto extends OpMode {
|
public class PreLoadedBlueBasketAuto extends OpMode {
|
||||||
private Telemetry telemetryA;
|
private Telemetry telemetryA;
|
||||||
@ -118,5 +119,6 @@ public class PreLoadedBlueBasketAuto extends OpMode {
|
|||||||
public void loop() {
|
public void loop() {
|
||||||
follower.update();
|
follower.update();
|
||||||
follower.telemetryDebug(telemetryA);
|
follower.telemetryDebug(telemetryA);
|
||||||
|
|
||||||
}
|
}
|
||||||
}
|
}
|
||||||
|
@ -19,6 +19,8 @@ public class RobotConstants {
|
|||||||
public final static int liftToFloorPos = 350;
|
public final static int liftToFloorPos = 350;
|
||||||
public final static int liftToSubmarinePos = 350;
|
public final static int liftToSubmarinePos = 350;
|
||||||
public final static int liftToLowBucketPos = 2250;
|
public final static int liftToLowBucketPos = 2250;
|
||||||
|
public final static int liftToHighRung = 2250;
|
||||||
|
|
||||||
public final static int liftToHighBucketPos = 3850;
|
public final static int liftToHighBucketPos = 3850;
|
||||||
public final static double liftPower = .625;
|
public final static double liftPower = .625;
|
||||||
}
|
}
|
@ -21,7 +21,7 @@ public class LiftActionsSubsystem {
|
|||||||
public DcMotor lift;
|
public DcMotor lift;
|
||||||
|
|
||||||
public enum LiftState {
|
public enum LiftState {
|
||||||
FLOOR, LOW_BUCKET, HIGH_BUCKET, FLOAT, SUBMARINE
|
FLOOR, LOW_BUCKET, HIGH_BUCKET, FLOAT, SUBMARINE,
|
||||||
}
|
}
|
||||||
|
|
||||||
private LiftState liftState;
|
private LiftState liftState;
|
||||||
@ -58,6 +58,7 @@ public class LiftActionsSubsystem {
|
|||||||
|
|
||||||
public Action toLowBucketPosition() {
|
public Action toLowBucketPosition() {
|
||||||
return new MoveToPosition(liftToLowBucketPos, LiftState.LOW_BUCKET);
|
return new MoveToPosition(liftToLowBucketPos, LiftState.LOW_BUCKET);
|
||||||
|
|
||||||
}
|
}
|
||||||
|
|
||||||
public Action toHighBucketPosition() {
|
public Action toHighBucketPosition() {
|
||||||
|
Reference in New Issue
Block a user