Call deleteMaps before initMaps

It seems it was a memory leak, because calling `initMaps` allocates new memory for `costmap_` without de-allocating the previous one!