已知一系列点在A坐标系下的坐标和B坐标系下对应的坐标,求两个坐标系之间的转换关系。
把RT作为未知数表示出来
取n个对应点,联立方程得AX=b
X=A\b
matlab代码如下:
function [ X ] = ReadX( path )
%READXWORLD 此处显示有关此函数的摘要
% 此处显示详细说明
%读入txt中的格式化数据:(1,2,3)
%type为1组成n列,type为其他组成1列
[x y z] = textread(path,'(%f,%f,%f)');
X=[x y z]';
end
function [ R T ] = SolveRT( path1,path2 )
%SOLVERT 此处显示有关此函数的摘要
% 此处显示详细说明
XWorld=Rea