Parking

data/sample_parking/goals_A.yaml

+goals:
+ - id: goal1
+   x: 8.18
+   y: 3.50
+   yaw: 1.5709
+   type: 0
+
+ - id: goal2
+   x: -1.22
+   y: 3.50
+   yaw: 4.7124
+   type: 1
+
+ - id: goal3
+   x: 3.75
+   y: 3.5
+   yaw: 1.5709
+   type: 2