mirror of
https://github.com/cjcliffe/CubicSDR.git
synced 2024-11-18 18:11:56 -05:00
b196fbfdea
RtAudio can’t open multiple streams, so now opening a new device will start a static audio thread and all other threads will attach/detach their input queues there.
128 lines
4.1 KiB
C++
128 lines
4.1 KiB
C++
#include "SDRPostThread.h"
|
|
#include "CubicSDRDefs.h"
|
|
#include <vector>
|
|
#include "CubicSDR.h"
|
|
|
|
SDRPostThread::SDRPostThread() :
|
|
iqDataInQueue(NULL), iqDataOutQueue(NULL), iqVisualQueue(NULL), terminated(false), dcFilter(NULL), sample_rate(SRATE) {
|
|
}
|
|
|
|
SDRPostThread::~SDRPostThread() {
|
|
}
|
|
|
|
void SDRPostThread::bindDemodulator(DemodulatorInstance *demod) {
|
|
demodulators.push_back(demod);
|
|
}
|
|
|
|
void SDRPostThread::removeDemodulator(DemodulatorInstance *demod) {
|
|
if (!demod) {
|
|
return;
|
|
}
|
|
|
|
std::vector<DemodulatorInstance *>::iterator i;
|
|
|
|
i = std::find(demodulators.begin(), demodulators.end(), demod);
|
|
|
|
if (i != demodulators.end()) {
|
|
demodulators.erase(i);
|
|
}
|
|
}
|
|
|
|
void SDRPostThread::setIQDataInQueue(SDRThreadIQDataQueue* iqDataQueue) {
|
|
iqDataInQueue = iqDataQueue;
|
|
}
|
|
void SDRPostThread::setIQDataOutQueue(SDRThreadIQDataQueue* iqDataQueue) {
|
|
iqDataOutQueue = iqDataQueue;
|
|
}
|
|
void SDRPostThread::setIQVisualQueue(SDRThreadIQDataQueue *iqVisQueue) {
|
|
iqVisualQueue = iqVisQueue;
|
|
}
|
|
|
|
void SDRPostThread::threadMain() {
|
|
int n_read;
|
|
double seconds = 0.0;
|
|
|
|
#ifdef __APPLE__
|
|
pthread_t tID = pthread_self(); // ID of this thread
|
|
int priority = sched_get_priority_max( SCHED_FIFO) - 1;
|
|
sched_param prio = { priority }; // scheduling priority of thread
|
|
pthread_setschedparam(tID, SCHED_FIFO, &prio);
|
|
#endif
|
|
|
|
dcFilter = iirfilt_crcf_create_dc_blocker(0.0005);
|
|
|
|
liquid_float_complex x, y;
|
|
|
|
std::cout << "SDR post-processing thread started.." << std::endl;
|
|
|
|
while (!terminated) {
|
|
SDRThreadIQData data_in;
|
|
|
|
iqDataInQueue.load()->pop(data_in);
|
|
|
|
if (data_in.data.size()) {
|
|
SDRThreadIQData dataOut;
|
|
|
|
dataOut.frequency = data_in.frequency;
|
|
dataOut.bandwidth = data_in.bandwidth;
|
|
dataOut.data = data_in.data;
|
|
|
|
for (int i = 0, iMax = dataOut.data.size() / 2; i < iMax; i++) {
|
|
x.real = (float) dataOut.data[i * 2] / 127.0;
|
|
x.imag = (float) dataOut.data[i * 2 + 1] / 127.0;
|
|
|
|
iirfilt_crcf_execute(dcFilter, x, &y);
|
|
|
|
dataOut.data[i * 2] = (signed char) floor(y.real * 127.0);
|
|
dataOut.data[i * 2 + 1] = (signed char) floor(y.imag * 127.0);
|
|
}
|
|
|
|
if (iqDataOutQueue != NULL) {
|
|
iqDataOutQueue.load()->push(dataOut);
|
|
}
|
|
|
|
if (iqVisualQueue != NULL) {
|
|
if (iqVisualQueue.load()->empty()) {
|
|
iqVisualQueue.load()->push(dataOut);
|
|
}
|
|
}
|
|
|
|
if (demodulators.size()) {
|
|
DemodulatorThreadIQData dummyDataOut;
|
|
dummyDataOut.frequency = data_in.frequency;
|
|
dummyDataOut.bandwidth = data_in.bandwidth;
|
|
DemodulatorThreadIQData demodDataOut;
|
|
demodDataOut.frequency = data_in.frequency;
|
|
demodDataOut.bandwidth = data_in.bandwidth;
|
|
demodDataOut.data = data_in.data;
|
|
|
|
std::vector<DemodulatorInstance *>::iterator i;
|
|
for (i = demodulators.begin(); i != demodulators.end(); i++) {
|
|
DemodulatorInstance *demod = *i;
|
|
DemodulatorThreadInputQueue *demodQueue = demod->threadQueueDemod;
|
|
|
|
if (demod->getParams().frequency != data_in.frequency
|
|
&& abs(data_in.frequency - demod->getParams().frequency) > (int) ((float) ((float) SRATE / 2.0) * 1.15)) {
|
|
if (demod->isActive()) {
|
|
demod->setActive(false);
|
|
demodQueue->push(dummyDataOut);
|
|
continue;
|
|
}
|
|
} else if (!demod->isActive()) {
|
|
demod->setActive(true);
|
|
}
|
|
|
|
demodQueue->push(demodDataOut);
|
|
}
|
|
}
|
|
}
|
|
}
|
|
std::cout << "SDR post-processing thread done." << std::endl;
|
|
}
|
|
|
|
void SDRPostThread::terminate() {
|
|
terminated = true;
|
|
SDRThreadIQData dummy;
|
|
iqDataInQueue.load()->push(dummy);
|
|
}
|