Open corradopav opened 9 years ago
fixed bug in the optimal path visualization- it was not buggy, it just do not visualize the optimal path if the planner returns before finishing (i.e. when it reaches the max number of samples)
ReConnect erases the wrong line! While adding new lines is correct. I believe that the data in plot_edges at some point lose coherence with the idX_near data.
This was fixed for the inverse pendulum case. Still visualization is problem-dependent and has to be setup case-by-case.
redesign the graph taking into account the rewiring phase