[mppi] add publish_critic_stats parameter for debug #5860
Merged
Add this suggestion to a batch that can be applied as a single commit.
This suggestion is invalid because no changes were made to the code.
Suggestions cannot be applied while the pull request is closed.
Suggestions cannot be applied while viewing a subset of changes.
Only one suggestion per line can be applied in a batch.
Add this suggestion to a batch that can be applied as a single commit.
Applying suggestions on deleted lines is not supported.
You must change the existing code in this line in order to create a valid suggestion.
Outdated suggestions cannot be applied.
This suggestion has been applied or marked resolved.
Suggestions cannot be applied from pending reviews.
Suggestions cannot be applied on multi-line comments.
Suggestions cannot be applied while the pull request is queued to merge.
Suggestion cannot be applied right now. Please check back later.
Basic Info
Description of contribution in a few bullet points
This PR backports #5485 to humble_main branch.
It allow to publish statistics about each MPPI critic's cost contributions in a /critic_stats topic featuring a new message type:
nav2_msgs/CritiicStatsDescription of documentation updates required from your changes
Changed the nav2_mppi_controller readme to describe the new feature. Changes were copied from #5485.
Description of how this change was tested
I tested with different critics (also custom ones) if the topic was behaving correctly: I verified that it publishes coherent data, respecting score magnitude and disabled critics.
I wrote a simple program to visualize the data in a plot to validate the changes. This is a test output.

For Maintainers:
backport-*.