File tree 1 file changed +1
-4
lines changed
planning/behavior_velocity_no_stopping_area_module/src
1 file changed +1
-4
lines changed Original file line number Diff line number Diff line change @@ -323,21 +323,18 @@ Polygon2d NoStoppingAreaModule::generateEgoNoStoppingAreaLanePolygon(
323
323
if (!is_in_area) {
324
324
return ego_area;
325
325
}
326
- double dist_from_area_sum = 0.0 ;
327
326
// decide end idx with extract distance
328
327
size_t ego_area_end_idx = ego_area_start_idx;
329
328
for (size_t i = ego_area_start_idx; i < pp.size () - 1 ; ++i) {
330
329
dist_from_start_sum += tier4_autoware_utils::calcDistance2d (pp.at (i), pp.at (i - 1 ));
331
330
const auto & p = pp.at (i).point .pose .position ;
332
331
if (!bg::within (Point2d{p.x , p.y }, lanelet::utils::to2D (no_stopping_area).basicPolygon ())) {
333
- dist_from_area_sum += tier4_autoware_utils::calcDistance2d (pp.at (i), pp.at (i - 1 ));
334
-
335
332
// do not take extra distance and exit as soon as p is outside no stopping area
336
333
// just a temporary fix
337
334
ego_area_end_idx = i - 1 ;
338
335
break ;
339
336
}
340
- if (dist_from_start_sum > extra_dist || dist_from_area_sum > margin ) {
337
+ if (dist_from_start_sum > extra_dist) {
341
338
break ;
342
339
}
343
340
++ego_area_end_idx;
You can’t perform that action at this time.
0 commit comments