Don't go into Intake mode if reset times out

This commit is contained in:
Keenan D. Buckley
2020-03-08 14:35:46 -06:00
parent 2a2b594b9c
commit 523be688cc
@@ -119,8 +119,10 @@ public class ManageStorage extends CommandBase {
private void runReset() {
m_storage.runStorage(-StorageConstants.STORAGE_SPEED);
if (isBallInIntake || (m_resetStartTime + StorageConstants.STORAGE_TIMEOUT) < System.currentTimeMillis()) {
if (isBallInIntake) {
m_storageMode = StorageMode.INTAKE;
} else if (m_resetStartTime + StorageConstants.STORAGE_TIMEOUT < System.currentTimeMillis()) {
m_storageMode = StorageMode.IDLE;
}
m_isStorageEmpty = !isBallInStorage;
}