-
Notifications
You must be signed in to change notification settings - Fork 665
New issue
Have a question about this project? Sign up for a free GitHub account to open an issue and contact its maintainers and the community.
By clicking “Sign up for GitHub”, you agree to our terms of service and privacy statement. We’ll occasionally send you account related emails.
Already on GitHub? Sign in to your account
feat(autoware_behavior_velocity_planner_common,autoware_behavior_velocity_stop_line_module): revert pr7710 and Check next_lane_id in createTargetPoint on stop line #7896
Conversation
…d check from arc_lane_util (autowarefoundation#7710)" This reverts commit be02771.
Signed-off-by: Y.Hisaki <yhisaki31@gmail.com>
Thank you for contributing to the Autoware project! 🚧 If your pull request is in progress, switch it to draft mode. Please ensure:
|
Codecov ReportAttention: Patch coverage is
Additional details and impacted files@@ Coverage Diff @@
## main #7896 +/- ##
==========================================
- Coverage 28.43% 28.42% -0.01%
==========================================
Files 1588 1592 +4
Lines 116175 116235 +60
Branches 49542 49549 +7
==========================================
+ Hits 33032 33044 +12
- Misses 74131 74195 +64
+ Partials 9012 8996 -16
*This pull request uses carry forward flags. Click here to find out more. ☔ View full report in Codecov by Sentry. |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
getNextLaneletWithinRoute should be used instead of getNextLanelets
@@ -51,8 +49,15 @@ bool StopLineModule::modifyPathVelocity(PathWithLaneId * path, StopReason * stop | |||
stop_line_[0], stop_line_[1], planner_data_->stop_line_extend_length); | |||
|
|||
// Calculate stop pose and insert index | |||
auto lane = this->planner_data_->route_handler_->getLaneletsFromId(lane_id_); | |||
auto next_lanes = this->planner_data_->route_handler_->getNextLanelets(lane); |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
Please add a previous lanes as well.
@@ -51,8 +49,15 @@ bool StopLineModule::modifyPathVelocity(PathWithLaneId * path, StopReason * stop | |||
stop_line_[0], stop_line_[1], planner_data_->stop_line_extend_length); | |||
|
|||
// Calculate stop pose and insert index | |||
auto lane = this->planner_data_->route_handler_->getLaneletsFromId(lane_id_); |
There was a problem hiding this comment.
Choose a reason for hiding this comment
The reason will be displayed to describe this comment to others. Learn more.
Please add a comment since this change is not straightforward.
Signed-off-by: Y.Hisaki <yhisaki31@gmail.com>
It seems that there is a bug in the behavior_velocity_planner where the route is not subscribed, and the getNextLaneletsWithinRoute function cannot be used. In the future, I would like to fix this bug, but temporarily, I addressed it by using getNextLanelets. |
This pull request has been automatically marked as stale because it has not had recent activity. |
@yhisaki @takayuki5168 Do you still need this modification? I suggest you to revert it quickly if you need to since it will bring more conflicts. |
Description
The figure below illustrates the issue that occurs in the previous implementation. The red x represents the PathPointWithLaneId before resampling, the green x represents the PathPointWithLaneId after resampling, the blue lines represent the actual lane boundaries, and the purple line represents the stop_line. Ideally, the stop_line should intersect at a point with lane_id=30134, but due to the resampling effect, it is mistakenly determined to intersect at a point with lane_id=30322.
Tests performed
tested on psim