Squashed commit of the sb-vbs branch.

Includes the SD-VBS benchmarks modified to:
- Use libextra to loop as realtime jobs
- Preallocate memory before starting their main computation
- Accept input via stdin instead of via argc

Does not include the SD-VBS matlab code.

Fixes libextra execution in LITMUS^RT.

1 files changed, 30 insertions, 0 deletions

diff --git a/SD-VBS/common/toolbox/ikkjin/getANMS.m b/SD-VBS/common/toolbox/ikkjin/getANMS.m
new file mode 100755
index 0000000..a40d50c
--- /dev/null
+++ b/SD-VBS/common/toolbox/ikkjin/getANMS.m
@@ -0,0 +1,30 @@
+function [interestPnts]=getANMS(x, y, v, r, dataDir)
+MAX_LIMIT=100000;
+C_ROBUST=1;
+r_sq=r^2;
+points=[x y v];
+[n temp]=size(v);
+[srtdV srtdVIdx]=sort(v,'descend');
+srtdPnts=points(srtdVIdx,:);
+
+interestPnts=zeros(0,3);
+
+suppressR=ones(n,1)*MAX_LIMIT;
+supId=find(suppressR>r_sq);
+
+iter = 0;
+while length(supId)>0
+
+    interestPnts=[interestPnts; srtdPnts(supId(1),:)];
+    srtdPnts=srtdPnts(supId(2:end),:);
+    suppressR=suppressR(supId(2:end),:);
+ 
+    suppressR=min(suppressR,...
+        (C_ROBUST*interestPnts(end,3)>=srtdPnts(:,3)).*...
+            ((srtdPnts(:,1)-interestPnts(end,1)).^2 + (srtdPnts(:,2)-interestPnts(end,2)).^2)...
+        +(C_ROBUST*interestPnts(end,3)<srtdPnts(:,3))*...
+            MAX_LIMIT);
+     
+    iter = iter + 1;
+    supId=find(suppressR>r_sq);
+end