From 93a5ee2b4e2cafc29a88421b6adeb1d3bc915761 Mon Sep 17 00:00:00 2001
From: Felix Erckenbrecht <eligs@eligs.de>
Date: Sat, 2 Apr 2022 23:15:33 +0200
Subject: Add debug-to-file mode

---
 src/fl2k_ampliphase.c | 87 +++++++++++++++++++++++++++++++++++++++++++--------
 1 file changed, 74 insertions(+), 13 deletions(-)

diff --git a/src/fl2k_ampliphase.c b/src/fl2k_ampliphase.c
index 77830b9..5c50391 100644
--- a/src/fl2k_ampliphase.c
+++ b/src/fl2k_ampliphase.c
@@ -68,6 +68,7 @@ pthread_mutex_t cb_mutex;
 pthread_mutex_t iq_mutex;
 pthread_cond_t cb_cond;
 pthread_cond_t iq_cond;
+pthread_t dbg_thread;
 
 FILE *file;
 int8_t *itxbuf = NULL;
@@ -92,6 +93,8 @@ long int * pdslopebuf;
 int writepos, readpos;
 int swap_iq = 0;
 int ignore_eof = 0;
+int debug_to_file = 0;
+
 
 void usage(void)
 {
@@ -109,6 +112,7 @@ void usage(void)
             "\t                        complex - dual channel (stereo)\n"
             "\t[-w swap I & Q (invert spectrum)]\n"
             "\t[-e ignore EOF]\n"
+            "\t[-D Debug - write to file 'debug.out' instead of FL2K device]\n"
             "\tfilename (use '-' to read from stdin)\n\n"
     );
     exit(1);
@@ -478,6 +482,39 @@ void fl2k_callback(fl2k_data_info_t *data_info)
 }
 
 
+
+static void *file_worker(void *arg){
+    FILE * f;
+    uint32_t * filebuf;
+    int i;
+    const size_t len = sizeof(*filebuf) * FL2K_BUF_LEN;
+
+    f = arg;
+    filebuf = malloc(len);
+    if(filebuf == NULL){
+        fprintf(stderr,"Error allocating debug file buffer.\n");
+    }
+    else{
+        while(1){
+            for(i=0;i<FL2K_BUF_LEN;i++){
+                filebuf[i] = (itxbuf[i] & 0xff) | ((uint32_t) qtxbuf[i]) << 8;
+            }
+            if(fwrite(filebuf,1,sizeof(len),f) != len){
+                perror("Error writing to debug file");
+                break;
+            }
+            pthread_cond_signal(&cb_cond);
+        }
+    }
+    do_exit = 1;
+    pthread_mutex_lock(&iq_mutex);
+    pthread_cond_signal(&iq_cond);
+    pthread_mutex_unlock(&iq_mutex);
+    return NULL;
+}
+
+
+
 int main(int argc, char **argv)
 {
     int r, opt;
@@ -489,6 +526,7 @@ int main(int argc, char **argv)
     int input_freq_specified = 0;
     enum inputType_E input_type = INP_REAL;
     float modulation_index = 0.25; /* maximum phase modulation 0.25 * 2 * Pi -> 45° */
+    FILE * fDbg = NULL;
 
 #ifndef _WIN32
     struct sigaction sigact, sigign;
@@ -500,7 +538,7 @@ int main(int argc, char **argv)
     };
 
     while (1) {
-        opt = getopt_long(argc, argv, "ewd:c:i:s:t:m:", long_options, &option_index);
+        opt = getopt_long(argc, argv, "ewDd:c:i:s:t:m:", long_options, &option_index);
 
         /* end of options reached */
         if (opt == -1)
@@ -509,6 +547,9 @@ int main(int argc, char **argv)
         switch (opt) {
         case 0:
             break;
+        case 'D':
+            debug_to_file=1;
+            break;
         case 'd':
             dev_index = (uint32_t)atoi(optarg);
             break;
@@ -606,10 +647,26 @@ int main(int argc, char **argv)
     pthread_cond_init(&iq_cond, NULL);
     pthread_attr_init(&attr);
 
-    fl2k_open(&dev, (uint32_t)dev_index);
-    if (NULL == dev) {
-        fprintf(stderr, "Failed to open fl2k device #%d.\n", dev_index);
-        goto out;
+    if(debug_to_file){
+        fDbg = fopen("debug.out","wb");
+        if(fDbg == NULL){
+            fprintf(stderr, "Failed to open 'debug.out' file.\n");
+            perror("");
+            goto out;
+        }
+        r = pthread_create(&dbg_thread, &attr, file_worker, fDbg);
+        if (r < 0) {
+            fprintf(stderr, "Error spawning debug-file worker thread.\n");
+            goto out;
+        }
+    }
+    else
+    {
+        fl2k_open(&dev, (uint32_t)dev_index);
+        if (NULL == dev) {
+            fprintf(stderr, "Failed to open fl2k device #%d.\n", dev_index);
+            goto out;
+        }
     }
 
     r = pthread_create(&iq_thread, &attr, iq_worker, NULL);
@@ -619,15 +676,17 @@ int main(int argc, char **argv)
     }
 
     pthread_attr_destroy(&attr);
-    r = fl2k_start_tx(dev, fl2k_callback, NULL, 0);
+    if(!debug_to_file){
+        r = fl2k_start_tx(dev, fl2k_callback, NULL, 0);
 
-    /* Set the sample rate */
-    r = fl2k_set_sample_rate(dev, samp_rate);
-    if (r < 0)
-        fprintf(stderr, "WARNING: Failed to set sample rate. %d\n", r);
+        /* Set the sample rate */
+        r = fl2k_set_sample_rate(dev, samp_rate);
+        if (r < 0)
+            fprintf(stderr, "WARNING: Failed to set sample rate. %d\n", r);
 
-    /* read back actual frequency */
-    samp_rate = fl2k_get_sample_rate(dev);
+        /* read back actual frequency */
+        samp_rate = fl2k_get_sample_rate(dev);
+    }
 
     /* Calculate needed constants */
     rf_to_baseband_sample_ratio = samp_rate / input_freq;
@@ -648,7 +707,9 @@ int main(int argc, char **argv)
     ampliphase_modulator(input_type, modulation_index);
 
     out:
-    fl2k_close(dev);
+    if(!debug_to_file){
+        fl2k_close(dev);
+    }
 
     if (file != stdin)
         fclose(file);
-- 
cgit v1.2.3