Audio Input: implemented worker + thread

2026-06-02 14:04:46 -04:00 · 2020-11-13 16:22:29 +01:00
parent 4b397f0cc7
commit 6e3add76e3
5 changed files with 45 additions and 70 deletions
@@ -0,0 +1,121 @@
+///////////////////////////////////////////////////////////////////////////////////
+// Copyright (C) 2012 maintech GmbH, Otto-Hahn-Str. 15, 97204 Hoechberg, Germany //
+// written by Christian Daniel                                                   //
+// Copyright (C) 2020 Jon Beniston, M7RCE                                        //
+//                                                                               //
+// This program is free software; you can redistribute it and/or modify          //
+// it under the terms of the GNU General Public License as published by          //
+// the Free Software Foundation as version 3 of the License, or                  //
+// (at your option) any later version.                                           //
+//                                                                               //
+// This program is distributed in the hope that it will be useful,               //
+// but WITHOUT ANY WARRANTY; without even the implied warranty of                //
+// MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the                  //
+// GNU General Public License V3 for more details.                               //
+//                                                                               //
+// You should have received a copy of the GNU General Public License             //
+// along with this program. If not, see <http://www.gnu.org/licenses/>.          //
+///////////////////////////////////////////////////////////////////////////////////
+
+#include <QDebug>
+#include <stdio.h>
+#include <errno.h>
+
+#include "dsp/samplesinkfifo.h"
+#include "audio/audiofifo.h"
+
+#include "audioinputworker.h"
+
+AudioInputWorker::AudioInputWorker(SampleSinkFifo* sampleFifo, AudioFifo *fifo, QObject* parent) :
+    QObject(parent),
+    m_fifo(fifo),
+    m_running(false),
+    m_log2Decim(0),
+    m_iqMapping(AudioInputSettings::IQMapping::L),
+    m_convertBuffer(m_convBufSamples),
+    m_sampleFifo(sampleFifo)
+{
+}
+
+AudioInputWorker::~AudioInputWorker()
+{
+}
+
+void AudioInputWorker::startWork()
+{
+    connect(m_fifo, SIGNAL(dataReady()), this, SLOT(handleAudio()));
+    m_running = true;
+}
+
+void AudioInputWorker::stopWork()
+{
+    disconnect(m_fifo, SIGNAL(dataReady()), this, SLOT(handleAudio()));
+    m_running = false;
+}
+
+void AudioInputWorker::workIQ(unsigned int nbRead)
+{
+    // Map between left and right audio channels and IQ channels
+    if (m_iqMapping == AudioInputSettings::IQMapping::L)
+    {
+        for (uint32_t i = 0; i < nbRead; i++)
+            m_buf[i*2+1] = 0;
+    }
+    else if (m_iqMapping == AudioInputSettings::IQMapping::R)
+    {
+        for (uint32_t i = 0; i < nbRead; i++)
+        {
+            m_buf[i*2] = m_buf[i*2+1];
+            m_buf[i*2+1] = 0;
+        }
+    }
+    else if (m_iqMapping == AudioInputSettings::IQMapping::LR)
+    {
+        for (uint32_t i = 0; i < nbRead; i++)
+        {
+            qint16 t = m_buf[i*2];
+            m_buf[i*2] = m_buf[i*2+1];
+            m_buf[i*2+1] = t;
+        }
+    }
+
+    SampleVector::iterator it = m_convertBuffer.begin();
+
+    switch (m_log2Decim)
+    {
+    case 0:
+        m_decimatorsIQ.decimate1(&it, m_buf, 2*nbRead);
+        break;
+    case 1:
+        m_decimatorsIQ.decimate2_cen(&it, m_buf, 2*nbRead);
+        break;
+    case 2:
+        m_decimatorsIQ.decimate4_cen(&it, m_buf, 2*nbRead);
+        break;
+    case 3:
+        m_decimatorsIQ.decimate8_cen(&it, m_buf, 2*nbRead);
+        break;
+    case 4:
+        m_decimatorsIQ.decimate16_cen(&it, m_buf, 2*nbRead);
+        break;
+    case 5:
+        m_decimatorsIQ.decimate32_cen(&it, m_buf, 2*nbRead);
+        break;
+    case 6:
+        m_decimatorsIQ.decimate64_cen(&it, m_buf, 2*nbRead);
+        break;
+    default:
+        break;
+    }
+
+    m_sampleFifo->write(m_convertBuffer.begin(), it);
+}
+
+void AudioInputWorker::handleAudio()
+{
+    uint32_t nbRead;
+
+    while ((nbRead = m_fifo->read((unsigned char *) m_buf, m_convBufSamples)) != 0) {
+        workIQ(nbRead);
+    }
+}