pyrobosim.utils.search_graph.SearchGraph.nearest

SearchGraph.nearest(pose)

Get the nearest node in the graph to a specified pose. :param pose: Query pose :type pose: pyrobosim.utils.pose.Pose :return: The nearest node to the query pose, or None if the graph is empty. :rtype: pyrobosim.utils.search_graph.Node