Remove cusps points from plot

diff --git a/plot.py b/plot.py
index 44ba684c4f48c2a71b3516a9ad29ba7105878cda..63348b7d747b94ca34b3dab3431131aafd343894 100644 (file)
--- a/plot.py
+++ b/plot.py
@@ -197,11 +197,6 @@ if __name__ == "__main__":
                                 label=t["cost"][traj])
         except:
             print("No trajectory")
-        for i in range(len(t["traj"][-1]) - 1):
-            n1 = t["traj"][-1][i]
-            n2 = t["traj"][-1][i + 1]
-            if (sign(n1[4]) != sign(n2[4])):
-                plt.plot(n2[0], n2[1], color=COLOR["log"][1], marker=".")
     plt.plot(*plot_nodes([s["init"]]), color=COLOR["start"], marker=".")
     plt.plot(*plot_nodes([s["goal"]]), color=COLOR["goal"], marker=".")
     # end plot here