From f618466c25d43f3bae9e40920273bf77de1e1149 Mon Sep 17 00:00:00 2001
From: leochanj105 <leochanj@live.unc.edu>
Date: Mon, 19 Oct 2020 23:09:30 -0400
Subject: initial sd-vbs

initial sd-vbs

add sd-vbs

sd-vbs
---
 .../localization/src/matlab/readSensorData.m       | 46 ++++++++++++++++++++++
 1 file changed, 46 insertions(+)
 create mode 100644 SD-VBS/benchmarks/localization/src/matlab/readSensorData.m

(limited to 'SD-VBS/benchmarks/localization/src/matlab/readSensorData.m')

diff --git a/SD-VBS/benchmarks/localization/src/matlab/readSensorData.m b/SD-VBS/benchmarks/localization/src/matlab/readSensorData.m
new file mode 100644
index 0000000..e84a6db
--- /dev/null
+++ b/SD-VBS/benchmarks/localization/src/matlab/readSensorData.m
@@ -0,0 +1,46 @@
+function [retTStamp, retType, retData, retEOF, index]=readSensorData(index1, fid)
+
+index = index1+1;
+rows = size(fid, 1);
+retTStamp = 0;
+retType = 0;
+retData = zeros(1,8);
+
+if(index > rows)
+    retEOF = 1;
+else
+%     for i=index:rows
+%         index = i;
+%         if(fid(i,2) == 4)
+%             break;
+%         end
+%     end
+    if(index == rows)
+        retEOF = 1;
+    else
+        retEOF = 0;
+    end
+
+    k = index;
+    retTStamp=fid(k,1);
+    retType=fid(k,2);
+    if(fid(k, 2) == 1 || fid(k, 2) == 2 || fid(k, 2) == 3)
+        index = k;
+        for i=1:3
+            retData(1,i)=fid(k,i+2);
+%            fprintf(1,'retData,i -> %f\t%d\n', retData(1,i), i);
+        end
+    end
+    if(fid(k, 2) == 4)
+        index = k;
+        for i=1:3
+            retData(1,i)=fid(k,i+2);
+%            fprintf(1,'retData,i -> %f\t%d\n', retData(1,i), i);
+        end
+        for i=4:8
+            retData(1,i) = fid(k+1,i-3);
+%            fprintf(1,'retData,i -> %f\t%d\n', retData(1,i), i);
+        end
+        index = index + 1;        
+    end    
+end
-- 
cgit v1.2.2