Skip to content

Commit 4face85

Browse files
committed
add commnet
Signed-off-by: Mamoru Sobue <mamoru.sobue@tier4.jp>
1 parent 9be0da2 commit 4face85

File tree

1 file changed

+7
-0
lines changed
  • planning/behavior_velocity_blind_spot_module/src

1 file changed

+7
-0
lines changed

planning/behavior_velocity_blind_spot_module/src/scene.cpp

+7
Original file line numberDiff line numberDiff line change
@@ -383,6 +383,13 @@ std::optional<std::pair<size_t, size_t>> BlindSpotModule::generateStopLine(
383383
geometry_msgs::build<geometry_msgs::msg::Point>().x(mid_pt.x()).y(mid_pt.y()).z(mid_pt.z());
384384
stop_idx_default_ip = stop_idx_critical_ip =
385385
motion_utils::findNearestSegmentIndex(path_ip.points, mid_point);
386+
/*
387+
// NOTE: it is not ambigious when the curve starts on the left/right lanelet, so this module
388+
inserts stopline at the beginning of the lanelet for baselink
389+
stop_idx_default_ip = stop_idx_critical_ip = static_cast<size_t>(std::max<int>(0,
390+
static_cast<int>(motion_utils::findNearestSegmentIndex(path_ip.points, mid_point)) -
391+
baselink2front_dist));
392+
*/
386393
}
387394

388395
/* insert stop_point to use interpolated path*/

0 commit comments

Comments
 (0)