Initial checkin for local min/max filter

Can be shortened to `r = cloud_projected->points[i].getVector3fMap ().norm();`