summaryrefslogtreecommitdiffstats
path: root/SD-VBS/common/toolbox/toolbox_basic/TOOLBOX_calib/projectedGrid.m
blob: 561a7d0b2c83ed59967ae5b8d41ccb5cc0b1ff58 (plain) (blame)
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
function [XX,H] = projectedGrid ( P1, P2, P3, P4 , nx, ny);

% new formalism using homographies

a00 = [P1;1];
a10 = [P2;1];
a11 = [P3;1];
a01 = [P4;1];

% Compute the planart collineation:

[H] = compute_collineation (a00, a10, a11, a01);


% Build the grid using the planar collineation:

x_l = ((0:(nx-1))'*ones(1,ny))/(nx-1);
y_l = (ones(nx,1)*(0:(ny-1)))/(ny-1);

pts = [x_l(:) y_l(:) ones(nx*ny,1)]';

XX = H*pts;

XX = XX(1:2,:) ./ (ones(2,1)*XX(3,:));