Skip to content
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

fix(behavior_velocity_planner): planning factor integration #10292

Merged
merged 11 commits into from
Mar 18, 2025

Conversation

satoshi-ota
Copy link
Contributor

Description

All behavior veloicty modules set redundant control point if the module made stop decision.

diff --git a/planning/behavior_velocity_planner/autoware_behavior_velocity_walkway_module/src/scene_walkway.cpp b/planning/behavior_velocity_planner/autoware_behavior_velocity_walkway_module/src/scene_walkway.cpp
index 4d8651d05c..827655daa2 100644
--- a/planning/behavior_velocity_planner/autoware_behavior_velocity_walkway_module/src/scene_walkway.cpp
+++ b/planning/behavior_velocity_planner/autoware_behavior_velocity_walkway_module/src/scene_walkway.cpp
@@ -123,7 +123,7 @@ bool WalkwayModule::modifyPathVelocity(PathWithLaneId * path)
 
     /* get stop point and stop factor */
     planning_factor_interface_->add(
-      path->points, planner_data_->current_odometry->pose, stop_pose.value(), stop_pose.value(),
+      path->points, planner_data_->current_odometry->pose, stop_pose.value(),
       autoware_internal_planning_msgs::msg::PlanningFactor::STOP,
       autoware_internal_planning_msgs::msg::SafetyFactorArray{}, true /*is_driving_forward*/,
       0.0 /*velocity*/, 0.0 /*shift distance*/, "walkway_stop");

Related links

Parent Issue:

How was this PR tested?

I confirmed modules output planning factor properly after fixing.

Notes for reviewers

None.

Interface changes

None.

Effects on system behavior

None.

Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>
Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>
Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>
Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>
Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>
Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>
Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>
Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>
Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>
Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>
Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>
@github-actions github-actions bot added the component:planning Route planning, decision-making, and navigation. (auto-assigned) label Mar 18, 2025
Copy link

Thank you for contributing to the Autoware project!

🚧 If your pull request is in progress, switch it to draft mode.

Please ensure:

@satoshi-ota satoshi-ota added run:build-and-test-differential Mark to enable build-and-test-differential workflow. (used-by-ci) run:clang-tidy-pr-review labels Mar 18, 2025
Copy link
Contributor

@soblin soblin left a comment

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

Okay except for crosswalk

@@ -881,7 +881,7 @@ void CrosswalkModule::applySlowDown(
}
if (slowdown_pose)
planning_factor_interface_->add(
output.points, planner_data_->current_odometry->pose, *slowdown_pose, *slowdown_pose,
output.points, planner_data_->current_odometry->pose, *slowdown_pose,
Copy link
Contributor

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

Maybe we have start & end point for slowdown.

Copy link
Contributor Author

Choose a reason for hiding this comment

The reason will be displayed to describe this comment to others. Learn more.

As far as I read the code, crosswalk module inserts one slow down start point, and all trajectory points are overwritten with same slow down velocity. Then, crosswalk has only one control point as well.

Copy link

codecov bot commented Mar 18, 2025

Codecov Report

Attention: Patch coverage is 0% with 22 lines in your changes missing coverage. Please review.

Project coverage is 26.04%. Comparing base (da5850e) to head (466e6bf).
Report is 6 commits behind head on main.

Files with missing lines Patch % Lines
...ity_intersection_module/src/scene_intersection.cpp 0.00% 15 Missing ⚠️
...avior_velocity_blind_spot_module/src/decisions.cpp 0.00% 2 Missing ⚠️
..._velocity_crosswalk_module/src/scene_crosswalk.cpp 0.00% 1 Missing ⚠️
...ction_module/src/scene_merge_from_private_road.cpp 0.00% 1 Missing ⚠️
...topping_area_module/src/scene_no_stopping_area.cpp 0.00% 1 Missing ⚠️
...e_behavior_velocity_stop_line_module/src/scene.cpp 0.00% 1 Missing ⚠️
...vior_velocity_walkway_module/src/scene_walkway.cpp 0.00% 1 Missing ⚠️
Additional details and impacted files
@@            Coverage Diff             @@
##             main   #10292      +/-   ##
==========================================
- Coverage   26.04%   26.04%   -0.01%     
==========================================
  Files        1375     1375              
  Lines      106439   106447       +8     
  Branches    40902    40899       -3     
==========================================
  Hits        27723    27723              
- Misses      76011    76018       +7     
- Partials     2705     2706       +1     
Flag Coverage Δ *Carryforward flag
differential 21.06% <0.00%> (?)
total 26.05% <ø> (+<0.01%) ⬆️ Carriedforward from da5850e

*This pull request uses carry forward flags. Click here to find out more.

☔ View full report in Codecov by Sentry.
📢 Have feedback on the report? Share it here.

🚀 New features to boost your workflow:
  • Test Analytics: Detect flaky tests, report on failures, and find test suite problems.

@satoshi-ota satoshi-ota merged commit 9c0877a into autowarefoundation:main Mar 18, 2025
59 of 61 checks passed
@satoshi-ota satoshi-ota deleted the fix/planning-factor-integ branch March 18, 2025 08:01
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
component:planning Route planning, decision-making, and navigation. (auto-assigned) run:build-and-test-differential Mark to enable build-and-test-differential workflow. (used-by-ci) run:clang-tidy-pr-review
Projects
Status: Done
Development

Successfully merging this pull request may close these issues.

2 participants