costmap_2d: fixed footprint bug in plugins.