Plot entry (to parking slot) node

diff --git a/plot.py b/plot.py
index 8860ce17e62e68014a088bc233b9c178ffe40f18..c0c3245f31f60b3862477db5a6d351e98f8ae2e3 100644 (file)
--- a/plot.py
+++ b/plot.py
@@ -225,6 +225,11 @@ if __name__ == "__main__":
     plt.plot(*car_frame(t["goal"]), color="red", lw=2)
     plt.plot(*plot_nodes([s["init"]]), color="red", marker="+", ms=12)
     plt.plot(*plot_nodes([t["goal"]]), color="red", marker="+", ms=12)
+    try: # middle
+        plt.plot(*car_frame(t["midd"]), color="red", lw=2)
+        plt.plot(*plot_nodes([t["midd"]]), color="red", marker="+", ms=12)
+    except:
+        pass
 
     plt.fill_between(
                 [-2.7, 3.25, 3.25, -2.7],