An idea to speed up the anisotropic ICP alogirthm was to reduce the points of the time of flight distance image from which the surface is generated. To test this idea, a downsampling filter is needed. The user should be able to specify the dimensions of the image desired. This should be restricted to be smaller or equal to the input image,since the goal is to downsample, not upsample.
This filter could also be useful for other future applications involving ToF processing.