feat(behavior_path_planenr): add pull out debug marker (autowarefound…

…ation#3482) Signed-off-by: kosuke55 <[email protected]>
soblin · Apr 20, 2023 · 85acbea · 85acbea
1 parent 50eca02
commit 85acbea
Showing 1 changed file with 3 additions and 1 deletion.
diff --git a/planning/behavior_path_planner/src/scene_module/pull_out/pull_out_module.cpp b/planning/behavior_path_planner/src/scene_module/pull_out/pull_out_module.cpp
@@ -809,7 +809,9 @@ void PullOutModule::setDebugData() const
   };
 
   debug_marker_.markers.clear();
-  add(createPoseMarkerArray(status_.pull_out_start_pose, "pull_out_start_pose", 0, 0.9, 0.3, 0.3));
+  add(createPoseMarkerArray(status_.pull_out_start_pose, "back_end_pose", 0, 0.9, 0.3, 0.3));
+  add(createPoseMarkerArray(status_.pull_out_path.start_pose, "start_pose", 0, 0.3, 0.9, 0.3));
+  add(createPoseMarkerArray(status_.pull_out_path.end_pose, "end_pose", 0, 0.9, 0.9, 0.3));
   add(createPathMarkerArray(getFullPath(), "full_path", 0, 0.0, 0.5, 0.9));
 }
 }  // namespace behavior_path_planner