From b989e759008884e95545ad9c7f8b64da9267298c Mon Sep 17 00:00:00 2001
From: XANTRONIX Development
Date: Fri, 18 Feb 2022 23:03:23 -0500
Subject: Implement dotf()

Implement dotf() to produce dot product of matrices
---
 src/spatial.c | 22 ++++++++++++++++++++++
 1 file changed, 22 insertions(+)

diff --git a/src/spatial.c b/src/spatial.c
index 98728df..f35749c 100644
--- a/src/spatial.c
+++ b/src/spatial.c
@@ -43,6 +43,28 @@ static int point_within_cone(xas_spatial_coord coord,
     return 1;
 }
 
+static float dotf(float *sets, size_t count, size_t len) {
+    float ret = 0.0f;
+
+    size_t x, y;
+
+    if (count == 0 || len == 0) {
+        return 0.0f;
+    }
+
+    for (x=0; x<count; x++) {
+        float num = sets[x*len+0];
+
+        for (y=1; y<len; y++) {
+            num *= sets[x*len+y];
+        }
+
+        ret += num;
+    }
+
+    return ret;
+}
+
 static int buffer_realloc(xas_spatial_scene *scene,
                           xas_spatial_buffer *buffer) {
     float seconds = scene->radius / scene->speed;
-- 
cgit v1.2.3