1 files changed, 94 insertions, 0 deletions
diff --git a/controller/fw/tools/freq_meas_test.c b/controller/fw/tools/freq_meas_test.c
new file mode 100644
index 0000000..01b4963
--- /dev/null
+++ b/controller/fw/tools/freq_meas_test.c
@@ -0,0 +1,94 @@
+
+#include <unistd.h>
+#include <stdio.h>
+#include <string.h>
+#include <errno.h>
+#include <stdlib.h>
+#include <sys/stat.h>
+#include <sys/types.h>
+#include <sys/fcntl.h>
+
+#include "freq_meas.h"
+
+void print_usage(void);
+
+void print_usage() {
+    fprintf(stderr, "Usage: freq_meas_test [test_data.bin]");
+}
+
+int main(int argc, char **argv) {
+    if (argc != 2) {
+        fprintf(stderr, "Error: Invalid arguments.\n");
+        print_usage();
+        return 1;
+    }
+
+    int fd = open(argv[1], O_RDONLY);
+    struct stat st;
+    if (fstat(fd, &st)) {
+        fprintf(stderr, "Error querying test data file size: %s\n", strerror(errno));
+        return 2;
+    }
+
+    if (st.st_size < 0 || st.st_size > 1000000) {
+        fprintf(stderr, "Error reading test data: too much test data (size=%zd)\n", st.st_size);
+        return 2;
+    }
+
+    if (st.st_size % sizeof(float) != 0) {
+        fprintf(stderr, "Error reading test data: file size is not divisible by %zd (size=%zd)\n", sizeof(float), st.st_size);
+        return 2;
+    }
+
+    char *buf = malloc(st.st_size);
+    if (!buf) {
+        fprintf(stderr, "Error allocating memory");
+        return 2;
+    }
+
+    size_t nread = 0;
+    while (nread < st.st_size) {
+        ssize_t rc = read(fd, buf, st.st_size - nread);
+
+        if (rc == -EINTR || rc == -EAGAIN)
+            continue;
+
+        if (rc < 0) {
+            fprintf(stderr, "Error reading test data: %s\n", strerror(errno));
+            return 2;
+        }
+        
+        if (rc == 0) {
+            fprintf(stderr, "Error reading test data: Unexpected end of file\n");
+            return 2;
+        }
+
+        nread += rc;
+    }
+
+    size_t n_samples = st.st_size / sizeof(float);
+    float *buf_f = (float *)buf;
+
+    uint16_t *sim_adc_buf = calloc(sizeof(uint16_t), n_samples);
+    if (!sim_adc_buf) {
+        fprintf(stderr, "Error allocating memory\n");
+        return 2;
+    }
+
+    for (size_t i=0; i<n_samples; i++)
+        sim_adc_buf[i] = 2048 + buf_f[i] * 2047;
+
+    for (size_t i=0; i<n_samples; i+=FMEAS_FFT_LEN) {
+
+        float out;
+        int rc = adc_buf_measure_freq(sim_adc_buf + i, &out);
+        if (rc) {
+            fprintf(stderr, "Simulation error in iteration %zd at position %zd: %d\n", i/FMEAS_FFT_LEN, i, rc);
+            return 3;
+        }
+
+        printf("%09zd %015f\n", i, out);
+    }
+
+    return 0;
+}