much improved priority queue implementation to speed up the path finder
much improved priority queue implementation to speed up the path finder