initial sd-vbs

initial sd-vbs

add sd-vbs

sd-vbs

1 files changed, 19 insertions, 0 deletions

diff --git a/SD-VBS/common/toolbox/toolbox_basic/TOOLBOX_calib/Rectangle2Square.m b/SD-VBS/common/toolbox/toolbox_basic/TOOLBOX_calib/Rectangle2Square.m
new file mode 100755
index 0000000..a6bbbe5
--- /dev/null
+++ b/SD-VBS/common/toolbox/toolbox_basic/TOOLBOX_calib/Rectangle2Square.m
@@ -0,0 +1,19 @@
+function [square] = Rectangle2Square(rectangle,L,W);
+
+% Generate the square from a rectangle of known segment lengths
+% from pt1 to pt2 : L
+% from pt2 to pt3 : W
+
+[u_hori,u_vert] = UnWarpPlane(rectangle);
+
+coeff_x = sqrt(W/L);
+coeff_y = 1/coeff_x;
+
+x_coord = [ 0 coeff_x  coeff_x 0];
+y_coord = [ 0 0 coeff_y coeff_y];
+
+
+square = rectangle(:,1) * ones(1,4) + u_hori*x_coord + u_vert*y_coord;
+square = square ./ (ones(3,1)*square(3,:));
+
+