translation.m

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

clc
clear
photo=load('tuxiang1.txt');

xf=photo(:,1);
yf=photo(:,2);
[M,N]=size(photo);
zw=zeros(M,1);

R=csvread('R.txt');
T=csvread('T.txt');
f=csvread('f.txt');
k1=csvread('k1.txt');

Ncx=1;
Nfx=1;
Cx=750;
Cy=650;
dx=0.0044708;
dy=0.0044708;
sx=1;

[Xw, Yw] = biaoding (xf, yf, Ncx, Nfx, dx, dy, Cx, Cy, sx,R,T,f,k1)