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 penalty-based cost function in STOMP #2625

Merged
merged 4 commits into from
Jan 16, 2024

Conversation

henningkayser
Copy link
Member

@henningkayser henningkayser commented Dec 20, 2023

This adds several test cases for STOMP's noise generation and cost functions, and provides the following fixes:

  • out-of-bounds vector access when tail states of trajectory are invalid
  • smoothed costs overriding values of previous invalid groups
  • missing validity check of last state in trajectory
  • inability to disable cost function interpolation steps
  • total cost of trajectory not summing up to sum of state penalties
  • bug in Gaussian producing infinite values with invalid start states

Fixes #2462, #2554

Copy link

codecov bot commented Dec 20, 2023

Codecov Report

Attention: 3 lines in your changes are missing coverage. Please review.

Comparison is base (627e95a) 50.91% compared to head (5c05678) 50.92%.

Files Patch % Lines
...ners/stomp/include/stomp_moveit/cost_functions.hpp 90.63% 3 Missing ⚠️
Additional details and impacted files
@@            Coverage Diff             @@
##             main    #2625      +/-   ##
==========================================
+ Coverage   50.91%   50.92%   +0.02%     
==========================================
  Files         387      391       +4     
  Lines       32430    32590     +160     
==========================================
+ Hits        16507    16592      +85     
- Misses      15923    15998      +75     

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

This adds several test cases for STOMP's noise generation and cost
functions, and provides the following fixes:

* out-of-bounds vector access when tail states of trajectory are invalid
* smoothed costs overriding values of previous invalid groups
* missing validity check of last state in trajectory
* inability to disable cost function interpolation steps
* total cost of trajectory not summing up to sum of state penalties
* bug in Gaussian producing infinite values with invalid start states
Copy link
Contributor

@sjahr sjahr left a comment

Choose a reason for hiding this comment

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

Thanks for fixing this! I have a couple of comments, mostly question to understand the changes better. Is there a good way to test the improvements?

@sjahr sjahr merged commit 0bb121b into moveit:main Jan 16, 2024
12 checks passed
Jakubivan pushed a commit to Jakubivan/moveit2 that referenced this pull request Mar 13, 2024
* Fix penalty-based cost function in STOMP

This adds several test cases for STOMP's noise generation and cost
functions, and provides the following fixes:

* out-of-bounds vector access when tail states of trajectory are invalid
* smoothed costs overriding values of previous invalid groups
* missing validity check of last state in trajectory
* inability to disable cost function interpolation steps
* total cost of trajectory not summing up to sum of state penalties
* bug in Gaussian producing infinite values with invalid start states

* Improve documentation

---------
Jakubivan pushed a commit to Jakubivan/moveit2 that referenced this pull request Mar 13, 2024
* Fix penalty-based cost function in STOMP

This adds several test cases for STOMP's noise generation and cost
functions, and provides the following fixes:

* out-of-bounds vector access when tail states of trajectory are invalid
* smoothed costs overriding values of previous invalid groups
* missing validity check of last state in trajectory
* inability to disable cost function interpolation steps
* total cost of trajectory not summing up to sum of state penalties
* bug in Gaussian producing infinite values with invalid start states

* Improve documentation

---------
Sign up for free to join this conversation on GitHub. Already have an account? Sign in to comment
Labels
None yet
Projects
None yet
Development

Successfully merging this pull request may close these issues.

Random crash with STOMP with path constraints
2 participants