Fix static costmap concurrency error
Add publisher back in