1 files changed, 33 insertions, 0 deletions

diff --git a/SD-VBS/benchmarks/localization/src/matlab/selfCheck.m b/SD-VBS/benchmarks/localization/src/matlab/selfCheck.m
new file mode 100644
index 0000000..ac80ebd
--- /dev/null
+++ b/SD-VBS/benchmarks/localization/src/matlab/selfCheck.m
@@ -0,0 +1,33 @@
+function ret = selfCheck(in1, in2, tol)
+
+r1 = size(in1, 1);
+c1 = size(in1, 2);
+
+r2 = size(in2, 1);
+c2 = size(in2, 2);
+
+ret = 1;
+
+if r1~=r2 
+    disp(1298);
+    ret = 0;
+end
+
+if c1 ~= c2
+        disp(1297);
+        ret = 0;
+end
+
+for i=1:r1
+    if(ret == 0)
+        break;
+    end
+    for j=1:c1
+        if( abs(in1(i,j)-in2(i,j)) > tol)
+            ret = 0;
+            break;
+        end
+    end
+end
+
+