Fixes for local costmap
Fix Local Obstacle Plugin and Publish all Cells