pyrobosim.utils.search_graph.SearchGraphPlanner.heuristic_cost_estimate

SearchGraphPlanner.heuristic_cost_estimate(n0, n1)

Compute heuristic cost estimate using linear distance. :param n0: First node :type n0: pyrobosim.utils.search_graph.Node :param n1: Second node :type n1: pyrobosim.utils.search_graph.Node :return: Heuristic cost estimate :rtype: float