[gladys] extract point and graph_astar from nav_graph.hpp