not downsampling the new_xyz when computing costs