fixing fibheap and pathfinder, almost done