calibration

This commit is contained in:
2026-06-09 09:29:32 -05:00
parent d0ee294d26
commit 1cd14021dd
2 changed files with 5 additions and 5 deletions

View File

@@ -31,7 +31,7 @@ public class TeleopV4 extends LinearOpMode {
ParkTilter parkTilter;
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);
private boolean firstTickFull = true;
@@ -122,9 +122,9 @@ public class TeleopV4 extends LinearOpMode {
if (gamepad1.crossWasPressed()){
if (Color.redAlliance){
relocalizePose = new Pose(57.5, 5, 0);
relocalizePose = new Pose(54.4, 12, 0);
} else {
relocalizePose = new Pose(-57.5, 5, Math.toRadians(180));
relocalizePose = new Pose(-54.4, 12, Math.toRadians(180));
}
follower.setPose(relocalizePose);
sleep(500);

View File

@@ -53,7 +53,7 @@ public class SpindexerTransferIntake {
}
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
private DesiredPattern desiredPattern = DesiredPattern.GPP;
@@ -205,7 +205,7 @@ public class SpindexerTransferIntake {
private RapidMode rapidMode = RapidMode.INTAKE;
private SortedIntakeStates sortedIntakeStates = SortedIntakeStates.IDLE;
private BallStates[] ballColors = {BallStates.UNKNOWN, BallStates.UNKNOWN, BallStates.UNKNOWN};
final double greenThresh = 0.39;
final double greenThresh = 0.41;
final double spinMovementTime = 250;
/**