StaticLayer map-resize erases all obstacles from ObstacleLayer

asked 2017-02-09 07:18:12 -0500

385 ●18 ●27 ●27

updated 2017-02-09 07:19:16 -0500

I am using Google Cartographer as SLAM component, and move_base for navigation. In the config of the global costmap, I have setup costmap_2d::StaticLayer to subscribe to the /map topic published by cartographer. There is also an ObstacleLayer and an InflationLayer. My problem is that each time cartographer dynamically adjusts the map size, all obstacles which have been added to the global costmap get erased.

Looking at the code of static_layer.cpp I can see that StaticLayer::incomingMap() is executed when a map with new dimensions is received. In this function, there is a section that initializes the costmap with static data.

How can I prevent the StaticLayer from erasing previously discovered obstacles from the ObstacleLayer to get erased from the master costmap (i.e. global costmap)?

Thanks

edit retag flag offensive close merge delete

add a comment

Comments

You're right, each time StaticLayer::incomingMap() is executed, Costmap2D::resizeMap() is called on all other layers. In this function, initMaps() and resetMaps() wipes the existing data. Do you have any suggestions how to modify Costmap2D::resizeMap() to preserve the data?

Huibuh ( 2017-02-23 08:38:07 -0500 )edit

It would involve a substantial amount of changes. The implementation should probably be similar to Costmap2D::updateOrigin which also changes the coordinate system of the map while keeping some of the data.

David Lu ( 2017-03-26 10:47:25 -0500 )edit

add a comment

StaticLayer map-resize erases all obstacles from ObstacleLayer

1 Answer

Comments

Question Tools

Stats

Related questions

StaticLayer map-resize erases all obstacles from ObstacleLayer edit

1 Answer

Comments

Question Tools

Stats

Related questions

StaticLayer map-resize erases all obstacles from ObstacleLayer