pyrobosim.utils.search_graph.SearchGraph.nearest

SearchGraph.nearest(pose: Pose) → Node | None

Get the nearest node in the graph to a specified pose.

Parameters:

pose – Query pose

Returns:

The nearest node to the query pose, or None if the graph is empty.