pyrobosim.utils.search_graph.SearchGraphPlanner.heuristic_cost_estimate

SearchGraphPlanner.heuristic_cost_estimate(n0: Node, n1: Node) → float

Compute heuristic cost estimate using linear distance.

Parameters:

• n0 – First node

• n1 – Second node

Returns:

Heuristic cost estimate