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

feat(avoidance): output feasible avoidance path #4145

Merged

Conversation

satoshi-ota
Copy link
Contributor

@satoshi-ota satoshi-ota commented Jul 3, 2023

Description

Currently, avoidance module outputs avoidance path only when there is the sufficient longitudinal distance. But this limitation maybe cause stuck because the ego stopped at obstacle stop position in worst case.

In this PR, I improve the logic so that it outputs feasible shift path if the longitudinal distance between ego and object is NOT enough to shift target lateral length.

simplescreenrecorder-2023-07-10_19.23.07.mp4

Tests performed

Effects on system behavior

Improve avoidance behavior

Pre-review checklist for the PR author

The PR author must check the checkboxes below when creating the PR.

In-review checklist for the PR reviewers

The PR reviewers must check the checkboxes below before approval.

Post-review checklist for the PR author

The PR author must check the checkboxes below before merging.

  • There are no open discussions or they are tracked via tickets.

After all checkboxes are checked, anyone who has write access can merge the PR.

@github-actions github-actions bot added the component:planning Route planning, decision-making, and navigation. (auto-assigned) label Jul 3, 2023
@codecov
Copy link

codecov bot commented Jul 3, 2023

Codecov Report

Patch coverage: 1.96% and project coverage change: -0.01 ⚠️

Comparison is base (d905e38) 15.23% compared to head (598e0f5) 15.23%.

Additional details and impacted files
@@            Coverage Diff             @@
##             main    #4145      +/-   ##
==========================================
- Coverage   15.23%   15.23%   -0.01%     
==========================================
  Files        1469     1469              
  Lines      101781   101805      +24     
  Branches    31396    31401       +5     
==========================================
+ Hits        15505    15507       +2     
- Misses      69414    69436      +22     
  Partials    16862    16862              
Flag Coverage Δ *Carryforward flag
differential 13.43% <1.96%> (?)
total 15.23% <ø> (+<0.01%) ⬆️ Carriedforward from d905e38

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

Impacted Files Coverage Δ
...r_path_planner/utils/path_shifter/path_shifter.hpp 0.00% <ø> (ø)
...th_planner/src/utils/path_shifter/path_shifter.cpp 6.71% <0.00%> (-0.08%) ⬇️
...er/src/scene_module/avoidance/avoidance_module.cpp 11.48% <2.08%> (-0.03%) ⬇️

☔ View full report in Codecov by Sentry.
📢 Do you have feedback about the report comment? Let us know in this issue.

@satoshi-ota satoshi-ota force-pushed the feat/feasible-shift branch 2 times, most recently from dc20990 to 04e2473 Compare July 5, 2023 10:15
@satoshi-ota satoshi-ota marked this pull request as ready for review July 5, 2023 10:17
@satoshi-ota satoshi-ota force-pushed the feat/feasible-shift branch 2 times, most recently from fb6564a to 598e0f5 Compare July 6, 2023 05:00
Signed-off-by: satoshi-ota <satoshi.ota928@gmail.com>
@satoshi-ota satoshi-ota force-pushed the feat/feasible-shift branch from 598e0f5 to 41f065f Compare July 10, 2023 07:32
@kyoichi-sugahara kyoichi-sugahara self-assigned this Jul 12, 2023
Comment on lines 557 to +558
double PathShifter::calcFeasibleVelocityFromJerk(
const double lateral, const double jerk, const double distance)
const double lateral, const double jerk, const double longitudinal)
Copy link
Contributor

@kyoichi-sugahara kyoichi-sugahara Jul 12, 2023

Choose a reason for hiding this comment

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

not related this PR but suggetion for variable name also for the function of calcLateralDistFromJerk

Suggested change
double PathShifter::calcFeasibleVelocityFromJerk(
const double lateral, const double jerk, const double distance)
const double lateral, const double jerk, const double longitudinal)
double PathShifter::calcFeasibleVelocityFromJerk(
const double lateral_deviation const double longitudinal_deviation, const double maximum_jerk)

Copy link
Contributor Author

Choose a reason for hiding this comment

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

Let's discuss proper name in other PR 👍

Copy link
Contributor

@kyoichi-sugahara kyoichi-sugahara left a comment

Choose a reason for hiding this comment

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

LGTM

@satoshi-ota satoshi-ota merged commit d6ba61a into autowarefoundation:main Jul 12, 2023
@satoshi-ota satoshi-ota deleted the feat/feasible-shift branch July 12, 2023 09:59
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)
Projects
None yet
Development

Successfully merging this pull request may close these issues.

2 participants