我正在尝试运行建议的代码 此处 由Harry R.(问题的第一个解决方案),我得到一个错误的说法是 cv2
没有 transform
方法。
Traceback (most recent call last):
File "/Users/kkk/PycharmProjects/TestICPPython3.7/ICPTest.py", line 64, in <module>
M2 = icp(a, b, [0.1, 0.33, np.pi / 2.2], 30)
File "/Users/kkk/PycharmProjects/TestICPPython3.7/ICPTest.py", line 32, in icp
src = cv2.transform(src, Tr[0:2])
AttributeError: module 'cv2' has no attribute 'transform'
有人收到这个吗?会有什么问题?谢谢大家
好吧,我终于在 Python 3.0 中得到了这个功能 (我想最初的版本是 Python 2.7) ,并且 不 在 Python 3.7 中。请注意,在Python 3.7中,有 cv2.estimateRigidTransform
改为 cv2.estimateAffinePartial2D
我们有两个返回变量,而不是原来代码中的一个,因为 cv2.estimateRigidTransform
现在被淘汰了。
import cv2
import numpy as np
import matplotlib.pyplot as plt
from sklearn.neighbors import NearestNeighbors
def icp(a, b, init_pose=(0, 0, 0), no_iterations=13):
"""
The Iterative Closest Point estimator.
Takes two cloudpoints a[x,y], b[x,y], an initial estimation of
their relative pose and the number of iterations
Returns the affine transform that transforms
the cloudpoint a to the cloudpoint b.
Note:
(1) This method works for cloudpoints with minor
transformations. Thus, the result depents greatly on
the initial pose estimation.
(2) A large number of iterations does not necessarily
ensure convergence. Contrarily, most of the time it
produces worse results.
"""
src = np.array([a.T], copy=True).astype(np.float32)
dst = np.array([b.T], copy=True).astype(np.float32)
# Initialise with the initial pose estimation
Tr = np.array([[np.cos(init_pose[2]), -np.sin(init_pose[2]), init_pose[0]],
[np.sin(init_pose[2]), np.cos(init_pose[2]), init_pose[1]],
[0, 0, 1]])
src = cv2.transform(src, Tr[0:2])
for i in range(no_iterations):
# Find the nearest neighbours between the current source and the
# destination cloudpoint
nbrs = NearestNeighbors(n_neighbors=1, algorithm='auto').fit(dst[0])
distances, indices = nbrs.kneighbors(src[0])
# Compute the transformation between the current source
# and destination cloudpoint
T, tmp = cv2.estimateAffinePartial2D(src, dst[0, indices.T], False)
# Transform the previous source and update the
# current source cloudpoint
src = cv2.transform(src, T)
# Save the transformation from the actual source cloudpoint
# to the destination
Tr = np.dot(Tr, np.vstack((T, [0, 0, 1])))
return Tr[0:2]
# Create the datasets
ang = np.linspace(-np.pi / 2, np.pi / 2, 320)
a = np.array([ang, np.sin(ang)])
th = np.pi / 2
rot = np.array([[np.cos(th), -np.sin(th)], [np.sin(th), np.cos(th)]])
b = np.dot(rot, a) + np.array([[0.2], [0.3]])
# Run the icp
M2 = icp(a, b, [0.1, 0.33, np.pi / 2.2], 30)
#
# # Plot the result
src = np.array([a.T]).astype(np.float32)
res = cv2.transform(src, M2)
plt.figure()
plt.plot(b[0], b[1])
plt.plot(res[0].T[0], res[0].T[1], 'r.')
plt.plot(a[0], a[1])
plt.show()