Moved checkAutoRoutine method out of DriverStation