[frontiers] change the lookout
[nav_graph] Add a new astar_search with detailed costs
[weight_map] getter for robot model and declaration of merging function