testdata.m

Tsai标定法的matlab实现 完成图像坐标到世界坐标的转换

clc
clear
x=load('shijie1.txt');
X=load('tuxiang1.txt');
Xf=X(:,1);
Yf=X(:,2);
xw=x(:,1);
yw=x(:,2);
[M,N]=size(x);
zw=zeros(M,1);
Ncx=1;
Nfx=1;
Cx=750;
Cy=650;
dx=0.0044708;
dy=0.0044708;
sx=1;
[R, T, f, k1] = Tsai(Xf, Yf, xw, yw, zw, Ncx, Nfx, dx, dy, Cx, Cy, sx)
csvwrite('R.txt',R);
csvwrite('T.txt',T);
csvwrite('f.txt',f);
csvwrite('k1.txt',k1);