Contents:
Connect a node to all nodes within connection distance.
node (pyrobosim.utils.search_graph.Node) – Node to try add to the graph.
pyrobosim.utils.search_graph.Node