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/is3D.m b/SD-VBS/common/toolbox/toolbox_basic/TOOLBOX_calib/is3D.m
new file mode 100755
index 0000000..ab00b3d
--- /dev/null
+++ b/SD-VBS/common/toolbox/toolbox_basic/TOOLBOX_calib/is3D.m
@@ -0,0 +1,19 @@
+function test = is3D(X),
+
+
+Np = size(X,2);
+
+%% Check for planarity of the structure:
+
+X_mean = mean(X')';
+
+Y = X - (X_mean*ones(1,Np));
+
+YY = Y*Y';
+
+[U,S,V] = svd(YY);
+
+r = S(3,3)/S(2,2);
+
+test = (r > 1e-3);
+