ClayFlannigan / icp

iterative closest point
Other
603 stars 153 forks source link

Slow distance measurement #1

Closed lericson closed 7 years ago

lericson commented 7 years ago

I replaced your distance thingy with this

        all_dists = cdist(src[0:3,:].T, dst[0:3,:].T, 'euclidean')
        indices = all_dists.argmin(axis=1)
        distances = all_dists[np.arange(all_dists.shape[0]), indices]
ClayFlannigan commented 7 years ago

Thanks @lericson. Good addition.