Taken into account that the footprint does not get out of the costmap to avoid problems with the obstacle cost function computation.