Fix costmap update not being published on force updates #93
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.
Description
Costmap2DROS::updateMap
is a public method that other components can call to force an update to happen outside of the usualCostmap2DROS::mapUpdateLoop
.Since
Costmap2DPublisher::updateBounds
is only called insideCostmap2DROS::mapUpdateLoop
, this means that when forcing a costmap update we are not updating the bounds of the publisher and thus will result in wrong visualization.To fix this, we have to ensure the bounds of the publisher are also updated on force updates.
This can be achieved by moving the logic for updating the publisher bounds to be inside
Costmap2DROS::updateMap
.Notice in the video below how there's wrong information remaining in the costmap after a force update.
This PR fixes that.
route_dev_layer_bug.mp4