Added RangeBasedPointFilter class and test into costmap_2d.