fixed segfault caused by costmap footprint function changes