calibration
This commit is contained in:
@@ -31,7 +31,7 @@ public class TeleopV4 extends LinearOpMode {
|
|||||||
ParkTilter parkTilter;
|
ParkTilter parkTilter;
|
||||||
MeasuringLoopTimes loopTimes;
|
MeasuringLoopTimes loopTimes;
|
||||||
|
|
||||||
public static Pose relocalizePose = new Pose(56, 11, 0);
|
public static Pose relocalizePose = new Pose(54.7, 11.4, 0);
|
||||||
public static Pose teleStart = new Pose(0,0,0);
|
public static Pose teleStart = new Pose(0,0,0);
|
||||||
|
|
||||||
private boolean firstTickFull = true;
|
private boolean firstTickFull = true;
|
||||||
@@ -122,9 +122,9 @@ public class TeleopV4 extends LinearOpMode {
|
|||||||
|
|
||||||
if (gamepad1.crossWasPressed()){
|
if (gamepad1.crossWasPressed()){
|
||||||
if (Color.redAlliance){
|
if (Color.redAlliance){
|
||||||
relocalizePose = new Pose(57.5, 5, 0);
|
relocalizePose = new Pose(54.4, 12, 0);
|
||||||
} else {
|
} else {
|
||||||
relocalizePose = new Pose(-57.5, 5, Math.toRadians(180));
|
relocalizePose = new Pose(-54.4, 12, Math.toRadians(180));
|
||||||
}
|
}
|
||||||
follower.setPose(relocalizePose);
|
follower.setPose(relocalizePose);
|
||||||
sleep(500);
|
sleep(500);
|
||||||
|
|||||||
@@ -53,7 +53,7 @@ public class SpindexerTransferIntake {
|
|||||||
}
|
}
|
||||||
|
|
||||||
int[] shootOrder = {0, 1, 2};
|
int[] shootOrder = {0, 1, 2};
|
||||||
public static final double sensorDistanceThreshold = 5.35;
|
public static final double sensorDistanceThreshold = 4.75;//4.85//5.35
|
||||||
final long pulseTime = 70; // ms
|
final long pulseTime = 70; // ms
|
||||||
|
|
||||||
private DesiredPattern desiredPattern = DesiredPattern.GPP;
|
private DesiredPattern desiredPattern = DesiredPattern.GPP;
|
||||||
@@ -205,7 +205,7 @@ public class SpindexerTransferIntake {
|
|||||||
private RapidMode rapidMode = RapidMode.INTAKE;
|
private RapidMode rapidMode = RapidMode.INTAKE;
|
||||||
private SortedIntakeStates sortedIntakeStates = SortedIntakeStates.IDLE;
|
private SortedIntakeStates sortedIntakeStates = SortedIntakeStates.IDLE;
|
||||||
private BallStates[] ballColors = {BallStates.UNKNOWN, BallStates.UNKNOWN, BallStates.UNKNOWN};
|
private BallStates[] ballColors = {BallStates.UNKNOWN, BallStates.UNKNOWN, BallStates.UNKNOWN};
|
||||||
final double greenThresh = 0.39;
|
final double greenThresh = 0.41;
|
||||||
final double spinMovementTime = 250;
|
final double spinMovementTime = 250;
|
||||||
|
|
||||||
/**
|
/**
|
||||||
|
|||||||
Reference in New Issue
Block a user