1 files changed, 37 insertions, 0 deletions

diff --git a/SD-VBS/benchmarks/localization/src/c/weightedSample.c b/SD-VBS/benchmarks/localization/src/c/weightedSample.c
new file mode 100644
index 0000000..28099e8
--- /dev/null
+++ b/SD-VBS/benchmarks/localization/src/c/weightedSample.c
@@ -0,0 +1,37 @@
+/********************************
+Author: Sravanthi Kota Venkata
+********************************/
+
+#include <stdio.h>
+#include <stdlib.h>
+#include <math.h>
+#include "localization.h"
+
+I2D* weightedSample(F2D* w)
+{
+    I2D *bin;
+    F2D *seed;
+    int n, i, j;
+
+    n = w->height;
+    seed = randWrapper(n, 1);
+    bin = iSetArray(n, 1, 0);
+
+    for(i=0; i<n; i++)
+    {
+        for(j=0; j<n; j++)
+        {
+            if(asubsref(seed,j) > 0)
+                asubsref(bin,j) = asubsref(bin,j) + 1;
+        }
+        for(j=0; j<n; j++)
+            asubsref(seed,j) = asubsref(seed,j) - asubsref(w,i);
+    }
+
+    free(seed);
+    return bin;
+}
+
+
+
+