Edges
rr.log("map/tree/edges", rr.LineStrips2D(tree.segments(), radii=0.0005, colours=[0, 0, 255, 128]))
New edges
rr.log("map/new/new_edge", rr.LineStrips2D([(closest_node.pos, new_point)], colours=[color], radii=0.001))
Vertices
rr.log("map/tree/vertices", rr.Points2D([node.pos for node in tree], radii=0.002), rr.AnyValues(value=[float(node.cost) for node in tree]))
Shut nodes
rr.log("map/new/close_nodes", rr.Points2D([node.pos for node in close_nodes]))
Closest node
rr.log("map/new/closest_node", rr.Points2D([closest_node.pos], radii=0.008))
Random factors
rr.log("map/new/random_point", rr.Points2D([random_point], radii=0.008))
New factors
rr.log("map/new/new_point", rr.Points2D([new_point], radii=0.008))
Path
rr.log("map/path", rr.LineStrips2D(segments, radii=0.002, colours=[0, 255, 255, 255]))