diff --git a/utils/estimate_pose.py b/utils/estimate_pose.py index 7824675..708dc89 100644 --- a/utils/estimate_pose.py +++ b/utils/estimate_pose.py @@ -74,7 +74,7 @@ def compute_similarity_transform(points_static, points_to_transform): p1c = p1+t1 covariance_matrix = p0c.dot(p1c.T) - U,S,V = np.linalg.svd(coveriance_matrix) + U,S,V = np.linalg.svd(covariance_matrix) R = U.dot(V) if np.linalg.det(R) < 0: R[:,2] *= -1 @@ -92,4 +92,4 @@ def estimate_pose(vertices): _,R,_ = P2sRt(P) # decompose affine matrix to s, R, t pose = matrix2angle(R) - return P, pose \ No newline at end of file + return P, pose