priorityQueue changed so that latest addition takes highest priority (being greedy)
fixed NavigatorGraph reference point
pathing works on basic 3x3 test