You can not select more than 25 topics
Topics must start with a letter or number, can include dashes ('-') and can be up to 35 characters long.
245 lines
6.6 KiB
245 lines
6.6 KiB
/////////////////////////////////////////////////////////////////////////////////// |
|
// Copyright (C) 2012 maintech GmbH, Otto-Hahn-Str. 15, 97204 Hoechberg, Germany // |
|
// written by Christian Daniel // |
|
// // |
|
// 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 // |
|
// // |
|
// 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 <stdio.h> |
|
#include <errno.h> |
|
#include "rtlsdrthread.h" |
|
#include "dsp/samplefifo.h" |
|
|
|
#define BLOCKSIZE 16384 |
|
|
|
RTLSDRThread::RTLSDRThread(rtlsdr_dev_t* dev, SampleFifo* sampleFifo, QObject* parent) : |
|
QThread(parent), |
|
m_running(false), |
|
m_dev(dev), |
|
m_convertBuffer(BLOCKSIZE), |
|
m_sampleFifo(sampleFifo), |
|
m_decimation(2) |
|
{ |
|
} |
|
|
|
RTLSDRThread::~RTLSDRThread() |
|
{ |
|
stopWork(); |
|
} |
|
|
|
void RTLSDRThread::startWork() |
|
{ |
|
m_startWaitMutex.lock(); |
|
start(); |
|
while(!m_running) |
|
m_startWaiter.wait(&m_startWaitMutex, 100); |
|
m_startWaitMutex.unlock(); |
|
} |
|
|
|
void RTLSDRThread::stopWork() |
|
{ |
|
m_running = false; |
|
wait(); |
|
} |
|
|
|
void RTLSDRThread::setDecimation(int decimation) |
|
{ |
|
m_decimation = decimation; |
|
} |
|
|
|
void RTLSDRThread::run() |
|
{ |
|
int res; |
|
|
|
m_running = true; |
|
m_startWaiter.wakeAll(); |
|
|
|
while(m_running) { |
|
if((res = rtlsdr_read_async(m_dev, &RTLSDRThread::callbackHelper, this, 32, BLOCKSIZE)) < 0) { |
|
qCritical("RTLSDRThread: async error: %s", strerror(errno)); |
|
break; |
|
} |
|
} |
|
|
|
m_running = false; |
|
} |
|
|
|
#if 0 |
|
|
|
void RTLSDRThread::decimate2(SampleVector::iterator* it, const quint8* buf, qint32 len) |
|
{ |
|
for(int pos = 0; pos < len; pos += 2) { |
|
Sample s((((qint8)buf[pos]) - 128) << 8, (((qint8)buf[pos + 1]) - 128) << 8); |
|
if(m_decimator2.workDecimateCenter(&s)) { |
|
**it = s; |
|
++(*it); |
|
} |
|
} |
|
} |
|
|
|
void RTLSDRThread::decimate4(SampleVector::iterator* it, const quint8* buf, qint32 len) |
|
{ |
|
for(int pos = 0; pos < len; pos += 2) { |
|
Sample s((((qint8)buf[pos]) - 128) << 8, (((qint8)buf[pos + 1]) - 128) << 8); |
|
if(m_decimator2.workDecimateCenter(&s)) { |
|
if(m_decimator4.workDecimateCenter(&s)) { |
|
**it = s; |
|
++(*it); |
|
} |
|
} |
|
} |
|
} |
|
|
|
void RTLSDRThread::decimate8(SampleVector::iterator* it, const quint8* buf, qint32 len) |
|
{ |
|
for(int pos = 0; pos < len; pos += 2) { |
|
Sample s((((qint8)buf[pos]) - 128) << 8, (((qint8)buf[pos + 1]) - 128) << 8); |
|
if(m_decimator2.workDecimateCenter(&s)) { |
|
if(m_decimator4.workDecimateCenter(&s)) { |
|
if(m_decimator8.workDecimateCenter(&s)) { |
|
**it = s; |
|
++(*it); |
|
} |
|
} |
|
} |
|
} |
|
} |
|
|
|
void RTLSDRThread::decimate16(SampleVector::iterator* it, const quint8* buf, qint32 len) |
|
{ |
|
for(int pos = 0; pos < len; pos += 2) { |
|
Sample s((((qint8)buf[pos]) - 128) << 8, (((qint8)buf[pos + 1]) - 128) << 8); |
|
if(m_decimator2.workDecimateCenter(&s)) { |
|
if(m_decimator4.workDecimateCenter(&s)) { |
|
if(m_decimator8.workDecimateCenter(&s)) { |
|
if(m_decimator16.workDecimateCenter(&s)) { |
|
**it = s; |
|
++(*it); |
|
} |
|
} |
|
} |
|
} |
|
} |
|
} |
|
|
|
#else |
|
|
|
void RTLSDRThread::decimate2(SampleVector::iterator* it, const quint8* buf, qint32 len) |
|
{ |
|
qint16 xreal, yimag; |
|
for (int pos = 0; pos < len + 7; pos += 8) { |
|
xreal = buf[pos+0] - buf[pos+3]; |
|
yimag = buf[pos+1] + buf[pos+2] - 255; |
|
Sample s( xreal << 6, yimag << 6 ); |
|
**it = s; |
|
(*it)++; |
|
xreal = buf[pos+7] - buf[pos+4]; |
|
yimag = 255 - buf[pos+5] - buf[pos+6]; |
|
Sample t( xreal << 6, yimag << 6 ); |
|
**it = t; |
|
(*it)++; |
|
} |
|
} |
|
void RTLSDRThread::decimate4(SampleVector::iterator* it, const quint8* buf, qint32 len) |
|
{ |
|
qint16 xreal, yimag; |
|
for (int pos = 0; pos < len + 7; pos += 8) { |
|
xreal = buf[pos+0] - buf[pos+3] + buf[pos+7] - buf[pos+4]; |
|
yimag = buf[pos+1] - buf[pos+5] + buf[pos+2] - buf[pos+6]; |
|
Sample s( xreal << 5, yimag << 5 ); |
|
**it = s; |
|
(*it)++; |
|
} |
|
} |
|
|
|
void RTLSDRThread::decimate8(SampleVector::iterator* it, const quint8* buf, qint32 len) |
|
{ |
|
qint16 xreal, yimag; |
|
for (int pos = 0; pos < len + 15; pos += 8) { |
|
xreal = buf[pos+0] - buf[pos+3] + buf[pos+7] - buf[pos+4]; |
|
yimag = buf[pos+1] - buf[pos+5] + buf[pos+2] - buf[pos+6]; |
|
pos += 8; |
|
xreal += buf[pos+0] - buf[pos+3] + buf[pos+7] - buf[pos+4]; |
|
yimag += buf[pos+1] - buf[pos+5] + buf[pos+2] - buf[pos+6]; |
|
|
|
Sample s( xreal << 4, yimag << 4 ); |
|
**it = s; |
|
(*it)++; |
|
} |
|
} |
|
|
|
void RTLSDRThread::decimate16(SampleVector::iterator* it, const quint8* buf, qint32 len) |
|
{ |
|
// Offset tuning: 4x downsample and rotate, then |
|
// downsample 4x more. [ rotate: 0, 1, -3, 2, -4, -5, 7, -6] |
|
qint16 xreal, yimag; |
|
for (int step = 0; step < len - 31; step +=32) { |
|
xreal = yimag = 0; |
|
for (int pos = step; pos < step + 32; pos += 8) { |
|
xreal += buf[pos+0] - buf[pos+3] + buf[pos+7] - buf[pos+4]; |
|
yimag += buf[pos+1] - buf[pos+5] + buf[pos+2] - buf[pos+6]; |
|
} |
|
Sample s( xreal << 3, yimag << 3 ); |
|
**it = s; |
|
(*it)++; |
|
} |
|
} |
|
#endif |
|
|
|
void RTLSDRThread::callback(const quint8* buf, qint32 len) |
|
{ |
|
qint16 xreal, yimag, phase; |
|
SampleVector::iterator it = m_convertBuffer.begin(); |
|
|
|
switch(m_decimation) { |
|
case 0: // 1:1 = no decimation |
|
// just rotation |
|
phase = -1; |
|
for (int pos = 0; pos < len + 3; pos += 4) { |
|
phase *= -1; |
|
xreal = phase * (buf[pos+0] - 127); |
|
yimag = phase * (buf[pos+1] - 127); |
|
*it++ = Sample( xreal<<7,yimag<<7); |
|
xreal = phase * (128 - buf[pos+3]); |
|
yimag = phase * (buf[pos+2] - 127); |
|
*it++ = Sample( xreal<<7,yimag<<7); |
|
} |
|
break; |
|
case 1: // 1:2 |
|
decimate2(&it, buf, len); |
|
break; |
|
|
|
case 2: // 1:4 |
|
decimate4(&it, buf, len); |
|
break; |
|
|
|
case 3: // 1:8 |
|
decimate8(&it, buf, len); |
|
break; |
|
|
|
case 4: // 1:16 |
|
decimate16(&it, buf, len); |
|
break; |
|
} |
|
|
|
m_sampleFifo->write(m_convertBuffer.begin(), it); |
|
|
|
if(!m_running) |
|
rtlsdr_cancel_async(m_dev); |
|
} |
|
|
|
void RTLSDRThread::callbackHelper(unsigned char* buf, uint32_t len, void* ctx) |
|
{ |
|
RTLSDRThread* thread = (RTLSDRThread*)ctx; |
|
thread->callback(buf, len); |
|
}
|
|
|