Untested code for point cloud filtering