check whether costmap is initalized before publishing
don't set initialized until updateMap is called
Merge pull request #149 from jonbinney/costmap_init

check whether costmap is initalized before publishing