fix(behavior_path_planner): geometric parallel parking debug pose (#1731

) Signed-off-by: kosuke55 <kosuke.tnp@gmail.com> Signed-off-by: kosuke55 <kosuke.tnp@gmail.com>
tier4 · Oct 13, 2022 · a98444c · a98444c
1 parent 9f0b623
commit a98444c
Showing 1 changed file with 2 additions and 2 deletions.
diff --git a/planning/behavior_path_planner/src/scene_module/utils/geometric_parallel_parking.cpp b/planning/behavior_path_planner/src/scene_module/utils/geometric_parallel_parking.cpp
@@ -460,8 +460,8 @@ std::vector<PathWithLaneId> GeometricParallelParking::planOneTrial(
   // debug
   Cr_.pose = Cr;
   Cr_.header = planner_data_->route_handler->getRouteHeader();
-  Cr_.pose = Cr;
-  Cr_.header = planner_data_->route_handler->getRouteHeader();
+  Cl_.pose = Cl;
+  Cl_.header = planner_data_->route_handler->getRouteHeader();
   start_pose_.pose = start_pose;
   start_pose_.header = planner_data_->route_handler->getRouteHeader();
   arc_end_pose_.pose = arc_end_pose;