-
Notifications
You must be signed in to change notification settings - Fork 640
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(planning_evaluator): add modified goal deviation #3053
feat(planning_evaluator): add modified goal deviation #3053
Conversation
Signed-off-by: kosuke55 <[email protected]>
0312db1
to
b06fa6c
Compare
Signed-off-by: kosuke55 <[email protected]>
Signed-off-by: kosuke55 <[email protected]>
@@ -77,5 +77,26 @@ Stat<double> calcVelocityDeviation(const Trajectory & ref, const Trajectory & tr | |||
return stat; | |||
} | |||
|
|||
Stat<double> calcPoseLongitudinalDeviation(const Pose & base_pose, const Pose & target_pose) |
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.
const Pose & target_pose
can be replaced with
const Point & target_point
?
if direction of target_pose is not used.
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.
thanks, fixed in 31c8b82
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.
(and 4ac91a0)
if (!metric_stat) { | ||
continue; | ||
} | ||
metric_stats_[static_cast<size_t>(metric)].push_back(*metric_stat); |
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.
TODO(sugahara)
fix memory leak
if (!ego_state_ptr_) { | ||
return; | ||
} | ||
|
||
auto start = now(); | ||
stamps_.push_back(traj_msg->header.stamp); |
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.
TODO(suaghara)
fix memory leak
Signed-off-by: kosuke55 <[email protected]>
Signed-off-by: kosuke55 <[email protected]>
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.
LGTM
Signed-off-by: kosuke55 <[email protected]>
Codecov ReportPatch coverage:
Additional details and impacted files@@ Coverage Diff @@
## main #3053 +/- ##
==========================================
+ Coverage 11.95% 12.00% +0.04%
==========================================
Files 1324 1324
Lines 92115 92198 +83
Branches 24627 24664 +37
==========================================
+ Hits 11011 11064 +53
+ Misses 69691 69688 -3
- Partials 11413 11446 +33
*This pull request uses carry forward flags. Click here to find out more.
... and 1 file with indirect coverage changes Help us with your feedback. Take ten seconds to tell us how you rate us. Have a feature suggestion? Share it here. ☔ View full report in Codecov by Sentry. |
fix and add tests in 6d3b9e3. checked it passed |
…tion#3053) * feat(planning_evaluator): add modified goal deviation Signed-off-by: kosuke55 <[email protected]> * add abs Signed-off-by: kosuke55 <[email protected]> * remove setModifiedGoal Signed-off-by: kosuke55 <[email protected]> * use Point and rename func Signed-off-by: kosuke55 <[email protected]> * fix func docs Signed-off-by: kosuke55 <[email protected]> * fix and add tests Signed-off-by: kosuke55 <[email protected]> --------- Signed-off-by: kosuke55 <[email protected]>
…tion#3053) * feat(planning_evaluator): add modified goal deviation Signed-off-by: kosuke55 <[email protected]> * add abs Signed-off-by: kosuke55 <[email protected]> * remove setModifiedGoal Signed-off-by: kosuke55 <[email protected]> * use Point and rename func Signed-off-by: kosuke55 <[email protected]> * fix func docs Signed-off-by: kosuke55 <[email protected]> * fix and add tests Signed-off-by: kosuke55 <[email protected]> --------- Signed-off-by: kosuke55 <[email protected]>
Description
Add metrics of deviation from the modified goal pose
Related links
Tests performed
TIER IV internal scenario test
Notes for reviewers
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.
After all checkboxes are checked, anyone who has write access can merge the PR.