Switched to Deque instead of Queue
Don't open doors for all directions too soon
Code refactoring
Don't go back to init floor when there's no activity