Matla + SVD 求解变换矩阵

超能力猪

已于 2023-11-28 20:43:50 修改

阅读量1k

点赞数

文章标签： matlab ransac 算法

于 2021-11-26 10:49:31 首次发布

本文链接：https://blog.csdn.net/weixin_42985364/article/details/121554932

版权

其他分类专栏收录该内容

12 篇文章 2 订阅

订阅专栏

该博客介绍了一个使用Singular Value Decomposition (SVD)进行点集配准的MATLAB函数。通过对输入点集进行重心计算、协方差矩阵构造及SVD分解，函数求得旋转矩阵RR和平移矩阵TT，从而实现点集间的旋转和平移变换。通过迭代计算，评估变换后的点集与目标点集的匹配误差msen。

摘要由CSDN通过智能技术生成

在这里插入图片描述

% svd分解迭代求取R,T
% 要求inputA和inputB点集没有尺度变换，只有旋转和平移
function [RR,TT,msen]=findhomobySVD(inputA,inputB) 

N=size(inputA,1);            
%2计算目标点集P的重心和参考点集X的重心
up=mean(inputA); %1*3的矩阵
ux=mean(inputB); %1*3的矩阵

%3_由点集P和X构造协方差矩阵
E=((inputA-repmat(up,N,1))'*(inputB-repmat(ux,N,1)));
%svd分解
[U,A,D]=svd(E);
%求旋转矩阵
RR=D*U';
%求平移矩阵
TT=ux'-RR*up';
inpB=(RR*inputA'+repmat(TT,1,N))';
su=0;
for i=1:N
    for j=1:3
        su=su+(inputB(i,j)-inpB(i,j))^2;
    end
end
msen=sqrt(su/N);
end