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(planning_evaluator): add modified goal deviation #3053

Merged
merged 6 commits into from
Mar 14, 2023

Conversation

kosuke55
Copy link
Contributor

@kosuke55 kosuke55 commented Mar 10, 2023

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.

  • The PR follows the pull request guidelines.
  • The PR has been properly tested.
  • The PR has been reviewed by the code owners.

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.
  • The PR is ready for merge.

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

@github-actions github-actions bot added the component:evaluator Evaluation tools for planning, localization etc. (auto-assigned) label Mar 10, 2023
@kosuke55 kosuke55 force-pushed the feat/modified_goal_deviation branch from 0312db1 to b06fa6c Compare March 12, 2023 16:01
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)
Copy link
Contributor

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.

Copy link
Contributor Author

Choose a reason for hiding this comment

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

thanks, fixed in 31c8b82

Copy link
Contributor Author

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);
Copy link
Contributor

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);
Copy link
Contributor

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]>
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

Signed-off-by: kosuke55 <[email protected]>
@codecov
Copy link

codecov bot commented Mar 14, 2023

Codecov Report

Patch coverage: 57.39% and project coverage change: +0.04 🎉

Comparison is base (def79f3) 11.95% compared to head (6d3b9e3) 12.00%.

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     
Flag Coverage Δ *Carryforward flag
differential 58.60% <57.39%> (?)
total 11.94% <ø> (-0.02%) ⬇️ Carriedforward from def79f3

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

Impacted Files Coverage Δ
...ator/include/planning_evaluator/metrics/metric.hpp 60.00% <ø> (ø)
.../include/planning_evaluator/metrics_calculator.hpp 0.00% <ø> (ø)
...r/planning_evaluator/src/motion_evaluator_node.cpp 2.04% <0.00%> (-0.05%) ⬇️
...planning_evaluator/src/planning_evaluator_node.cpp 36.75% <45.94%> (+2.37%) ⬆️
...ng_evaluator/test/test_planning_evaluator_node.cpp 56.04% <51.85%> (-1.61%) ⬇️
...ator/planning_evaluator/src/metrics_calculator.cpp 87.50% <90.00%> (+5.68%) ⬆️
...anning_evaluator/src/metrics/deviation_metrics.cpp 90.90% <100.00%> (+5.19%) ⬆️

... 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.
📢 Do you have feedback about the report comment? Let us know in this issue.

@kosuke55
Copy link
Contributor Author

fix and add tests in 6d3b9e3. checked it passed

@kosuke55 kosuke55 merged commit 38032f1 into autowarefoundation:main Mar 14, 2023
@kosuke55 kosuke55 deleted the feat/modified_goal_deviation branch March 14, 2023 04:32
kosuke55 added a commit to tier4/autoware.universe that referenced this pull request Mar 16, 2023
…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]>
satoshi-ota pushed a commit to satoshi-ota/autoware.universe that referenced this pull request Jun 20, 2023
…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]>
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
component:evaluator Evaluation tools for planning, localization etc. (auto-assigned)
Projects
None yet
Development

Successfully merging this pull request may close these issues.

2 participants