Change the container which was used for keeping navigating goals from std::vector into std::deque as it is being used as a queue(FIFO), but removing the first element in a vector is costly as all elements needs to be pushed forward.

Change the container which was used for keeping navigating goals from std::vector into std::deque as it is being used as a queue(FIFO), but removing the first element in a vector is costly as all elements needs to be pushed forward. #2356