createdlt.m

来自「一个很好用的摄像机标定程序」· M 代码 · 共 22 行

function [DLT, lambda] = createDLT( Fl, b1, b2, u0, v0, T, M )
%DEVELOPMENT PHASE
%
% DLT = createDLT( Fl, b1, b2, u0, v0, T, M )
%
% Fl - focal length
% b1, b2 - models the lack of orthogonality and difference in scale of the image axes
% u0, v0, coordinates of the image centre
% T - translation 3x4 matrix
% M - rotation 3x3 matrix
%
% CDLT - computed matrix
% lambda - normalisation scalar
%
% computes the 3x3 CDLT transformation matrix from the known parameters

V = [1, 0, -u0; 0, 1, -v0; 0, 0, 1];
B = [1 + b1, b2, 0; b2, 1 - b1, 0; 0, 0, 1];
F = [Fl, 0, 0; 0, Fl, 0; 0, 0, 1];

DLT = inv(V) * inv(B) * F * M * T;
lambda = DLT( 3, 4 );