Efficient Navigation Mesh Implementation