一、3D-3D:ICP 已知n个3D点,在两个坐标轴下的坐标分别为和,已匹配好,求外参sR,t。其中s为两个坐标系的尺度比,R为旋转矩阵,t为平移向量。 SVD方法: 存在关系 构建误差的最小二乘, 推导可得: