dltpoints.m

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

function points = DLTpoints(DLT, icoords, z)
%DEVELOPMENT PHASE
%
%get the point corresponding to the image positions icoords with the given z
%coordinate
%
%DLT ... 3 x 4
%icoords ... n x 2
%default z = 0
%
%points = n x 3

if (nargin < 3)
    z = 0;
end

n = size(icoords, 1);

tempDLT = DLT(:, [1 2 4]);
tempDLT(:, 3) = tempDLT(:, 3) + z * DLT(:, 3);

points = applyDLT(inv(tempDLT), icoords);
points = [points, z * ones(n, 1)];