diff --git a/src/main/java/frc/robot/subsystems/TurretSubsystem.java b/src/main/java/frc/robot/subsystems/TurretSubsystem.java index 57f2299..834271f 100644 --- a/src/main/java/frc/robot/subsystems/TurretSubsystem.java +++ b/src/main/java/frc/robot/subsystems/TurretSubsystem.java @@ -203,30 +203,37 @@ public class TurretSubsystem extends TestableSubsystem { @Override public void periodic() { - if(turretState == TurretState.HOMING) { - if(turretLimitSwitch.get()) - { // Turret has tripped the switch - turretMotor.stopMotor(); - turretOffsetInRotations = (turretMotorPosition.refresh().getValueAsDouble() - 1.323); - if(!Robot.isReal()){ - turretOffsetInRotations = 0; // Flip turret around + while(turretState != TurretState.READY) + { + long start = System.currentTimeMillis(); + while(System.currentTimeMillis()-1000