costmap_2d: moved footprint publisher source out of .h file, into footprint.cpp.