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.Point;
|
||||
|
||||
|
||||
@Autonomous(name = "Pre Loaded Blue Basket Auto", group = "Competition")
|
||||
public class PreLoadedBlueBasketAuto extends OpMode {
|
||||
private Telemetry telemetryA;
|
||||
@ -118,5 +119,6 @@ public class PreLoadedBlueBasketAuto extends OpMode {
|
||||
public void loop() {
|
||||
follower.update();
|
||||
follower.telemetryDebug(telemetryA);
|
||||
|
||||
}
|
||||
}
|
||||
|
@ -19,6 +19,8 @@ public class RobotConstants {
|
||||
public final static int liftToFloorPos = 350;
|
||||
public final static int liftToSubmarinePos = 350;
|
||||
public final static int liftToLowBucketPos = 2250;
|
||||
public final static int liftToHighRung = 2250;
|
||||
|
||||
public final static int liftToHighBucketPos = 3850;
|
||||
public final static double liftPower = .625;
|
||||
}
|
@ -21,7 +21,7 @@ public class LiftActionsSubsystem {
|
||||
public DcMotor lift;
|
||||
|
||||
public enum LiftState {
|
||||
FLOOR, LOW_BUCKET, HIGH_BUCKET, FLOAT, SUBMARINE
|
||||
FLOOR, LOW_BUCKET, HIGH_BUCKET, FLOAT, SUBMARINE,
|
||||
}
|
||||
|
||||
private LiftState liftState;
|
||||
@ -58,6 +58,7 @@ public class LiftActionsSubsystem {
|
||||
|
||||
public Action toLowBucketPosition() {
|
||||
return new MoveToPosition(liftToLowBucketPos, LiftState.LOW_BUCKET);
|
||||
|
||||
}
|
||||
|
||||
public Action toHighBucketPosition() {
|
||||
|
Reference in New Issue
Block a user