Only publishes when layered costmap initialzed, fixes seg fault at startup hopefully