A* stuff
need to redo a bunch of NavigatorGraph, graph reference point is different for different functions