diff options
Diffstat (limited to 'SD-VBS/common/toolbox/toolbox_basic/calib_bouguetj/projectedGrid.m')
-rwxr-xr-x | SD-VBS/common/toolbox/toolbox_basic/calib_bouguetj/projectedGrid.m | 24 |
1 files changed, 24 insertions, 0 deletions
diff --git a/SD-VBS/common/toolbox/toolbox_basic/calib_bouguetj/projectedGrid.m b/SD-VBS/common/toolbox/toolbox_basic/calib_bouguetj/projectedGrid.m new file mode 100755 index 0000000..561a7d0 --- /dev/null +++ b/SD-VBS/common/toolbox/toolbox_basic/calib_bouguetj/projectedGrid.m | |||
@@ -0,0 +1,24 @@ | |||
1 | function [XX,H] = projectedGrid ( P1, P2, P3, P4 , nx, ny); | ||
2 | |||
3 | % new formalism using homographies | ||
4 | |||
5 | a00 = [P1;1]; | ||
6 | a10 = [P2;1]; | ||
7 | a11 = [P3;1]; | ||
8 | a01 = [P4;1]; | ||
9 | |||
10 | % Compute the planart collineation: | ||
11 | |||
12 | [H] = compute_collineation (a00, a10, a11, a01); | ||
13 | |||
14 | |||
15 | % Build the grid using the planar collineation: | ||
16 | |||
17 | x_l = ((0:(nx-1))'*ones(1,ny))/(nx-1); | ||
18 | y_l = (ones(nx,1)*(0:(ny-1)))/(ny-1); | ||
19 | |||
20 | pts = [x_l(:) y_l(:) ones(nx*ny,1)]'; | ||
21 | |||
22 | XX = H*pts; | ||
23 | |||
24 | XX = XX(1:2,:) ./ (ones(2,1)*XX(3,:)); | ||