Init can be pose range in plot scenario

diff --git a/scripts/plot_json_objects_scenario.py b/scripts/plot_json_objects_scenario.py
index 0f17a9d94c70a8c32d7ff7f2dd12c150736c8cb1..9cc6ab4fde6c183b09876f25ba36ad1de2c356e3 100644 (file)
--- a/scripts/plot_json_objects_scenario.py
+++ b/scripts/plot_json_objects_scenario.py
@@ -407,6 +407,17 @@ if __name__ == "__main__":
             marker="+",
             ms=12
         )
+    if "init" in scenario and len(scenario["init"]) == 4:
+        plt.plot(*plot_car(scenario["init"]), color="red")
+        scenario["init"][2] = scenario["init"][3]
+        plt.plot(*plot_car(scenario["init"]), color="red")
+        plt.plot(
+            scenario["init"][0] - MINX,
+            scenario["init"][1] - MINY,
+            color="red",
+            marker="+",
+            ms=12
+        )
     if "entries" in scenario:
         for e in scenario["entries"]:
             plt.plot(*plot_car(e), color="orange")