1
0
mirror of https://github.com/f4exb/sdrangel.git synced 2025-02-03 09:44:01 -05:00

TestSource: fixes

This commit is contained in:
f4exb 2018-01-14 04:43:24 +01:00
parent 176792c0ce
commit e3575d5f5f
2 changed files with 34 additions and 37 deletions

View File

@ -30,6 +30,7 @@ TestSourceThread::TestSourceThread(SampleSinkFifo* sampleFifo, QObject* parent)
m_chunksize(0),
m_convertBuffer(TESTSOURCE_BLOCKSIZE),
m_sampleFifo(sampleFifo),
m_frequencyShift(0),
m_samplerate(48000),
m_log2Decim(4),
m_fcPos(0),
@ -39,10 +40,9 @@ TestSourceThread::TestSourceThread(SampleSinkFifo* sampleFifo, QObject* parent)
m_frequency(435*1000),
m_fcPosShift(0),
m_throttlems(TESTSOURCE_THROTTLE_MS),
m_throttleToggle(false)
m_throttleToggle(false),
m_mutex(QMutex::Recursive)
{
m_chunksize = (m_samplerate * 4 * m_throttlems) / 1000;
setBuffers(m_chunksize);
}
TestSourceThread::~TestSourceThread()
@ -52,7 +52,6 @@ TestSourceThread::~TestSourceThread()
void TestSourceThread::startWork()
{
qDebug("TestSourceThread::startWork");
m_startWaitMutex.lock();
m_elapsedTimer.start();
start();
@ -63,16 +62,18 @@ void TestSourceThread::startWork()
void TestSourceThread::stopWork()
{
qDebug("TestSourceThread::stopWork");
m_running = false;
wait();
}
void TestSourceThread::setSamplerate(int samplerate)
{
QMutexLocker mutexLocker(&m_mutex);
m_samplerate = samplerate;
m_chunksize = (m_samplerate * 4 * m_throttlems) / 1000;
setBuffers(m_chunksize);
m_chunksize = 4 * ((m_samplerate * (m_throttlems+(m_throttleToggle ? 1 : 0))) / 1000);
m_throttleToggle = !m_throttleToggle;
m_nco.setFreq(m_frequencyShift, m_samplerate);
}
void TestSourceThread::setLog2Decimation(unsigned int log2_decim)
@ -120,15 +121,11 @@ void TestSourceThread::run()
m_running = true;
m_startWaiter.wakeAll();
qDebug("TestSourceThread::run: starting");
while (m_running) // actual work is in the tick() function
{
sleep(1);
}
qDebug("TestSourceThread::run: ending");
m_running = false;
}
@ -140,43 +137,41 @@ void TestSourceThread::setBuffers(quint32 chunksize)
if (m_buf == 0)
{
qDebug() << "TestSourceThread::setBuffer: Allocate buffer";
m_buf = (quint8*) malloc(m_bufsize);
qDebug() << "TestSourceThread::setBuffer: Allocate buffer: "
<< " size: " << m_bufsize << " bytes"
<< " #samples: " << (m_bufsize/4);
m_buf = (qint16*) malloc(m_bufsize);
}
else
{
qDebug() << "TestSourceThread::setBuffer: Re-allocate buffer";
quint8 *buf = m_buf;
m_buf = (quint8*) realloc((void*) m_buf, m_bufsize);
if (!m_buf) free(buf);
qDebug() << "TestSourceThread::setBuffer: Re-allocate buffer: "
<< " size: " << m_bufsize << " bytes"
<< " #samples: " << (m_bufsize/4);
free(m_buf);
m_buf = (qint16*) malloc(m_bufsize);
}
m_convertBuffer.resize(chunksize/4);
qDebug() << "TestSourceThread::setBuffer: size: " << m_bufsize
<< " #samples: " << (m_bufsize/4);
}
}
void TestSourceThread::generate(quint32 chunksize)
{
quint32 n = chunksize / 2;
qint16 *buf = (qint16*) m_buf;
int n = chunksize / 2;
setBuffers(chunksize);
for (unsigned int i = 0; i < n;)
for (int i = 0; i < n-1;)
{
Complex c = m_nco.nextIQ();
buf[i] = c.real() * (1<<m_bitShift);
i++;
buf[i] = c.imag() * (1<<m_bitShift);
i++;
m_buf[i++] = (int16_t) (c.real() * (float) m_amplitudeBits);
m_buf[i++] = (int16_t) (c.imag() * (float) m_amplitudeBits);
}
callback(m_buf, n);
}
// call appropriate conversion (decimation) routine depending on the number of sample bits
void TestSourceThread::callback(const quint8* buf, qint32 len)
void TestSourceThread::callback(const qint16* buf, qint32 len)
{
SampleVector::iterator it = m_convertBuffer.begin();
@ -211,10 +206,10 @@ void TestSourceThread::tick()
if (throttlems != m_throttlems)
{
QMutexLocker mutexLocker(&m_mutex);
m_throttlems = throttlems;
m_chunksize = 4 * ((m_samplerate * (m_throttlems+(m_throttleToggle ? 1 : 0))) / 1000);
m_throttleToggle = !m_throttleToggle;
setBuffers(m_chunksize);
}
generate(m_chunksize);

View File

@ -53,12 +53,13 @@ private:
QWaitCondition m_startWaiter;
bool m_running;
quint8 *m_buf;
qint16 *m_buf;
quint32 m_bufsize;
quint32 m_chunksize;
SampleVector m_convertBuffer;
SampleSinkFifo* m_sampleFifo;
NCOF m_nco;
int m_frequencyShift;
int m_samplerate;
unsigned int m_log2Decim;
@ -73,18 +74,19 @@ private:
int m_throttlems;
QElapsedTimer m_elapsedTimer;
bool m_throttleToggle;
QMutex m_mutex;
Decimators<quint8, SDR_SAMP_SZ, 8> m_decimators_8;
Decimators<quint8, SDR_SAMP_SZ, 12> m_decimators_12;
Decimators<quint8, SDR_SAMP_SZ, 16> m_decimators_16;
Decimators<qint16, SDR_SAMP_SZ, 8> m_decimators_8;
Decimators<qint16, SDR_SAMP_SZ, 12> m_decimators_12;
Decimators<qint16, SDR_SAMP_SZ, 16> m_decimators_16;
void run();
void callback(const quint8* buf, qint32 len);
void callback(const qint16* buf, qint32 len);
void setBuffers(quint32 chunksize);
void generate(quint32 chunksize);
// Decimate according to specified log2 (ex: log2=4 => decim=16)
inline void convert_8(SampleVector::iterator* it, const quint8* buf, qint32 len)
inline void convert_8(SampleVector::iterator* it, const qint16* buf, qint32 len)
{
if (m_log2Decim == 0) {
m_decimators_8.decimate1(it, buf, len);
@ -162,7 +164,7 @@ private:
}
}
void convert_12(SampleVector::iterator* it, const quint8* buf, qint32 len)
void convert_12(SampleVector::iterator* it, const qint16* buf, qint32 len)
{
if (m_log2Decim == 0) {
m_decimators_12.decimate1(it, buf, len);
@ -240,7 +242,7 @@ private:
}
}
void convert_16(SampleVector::iterator* it, const quint8* buf, qint32 len)
void convert_16(SampleVector::iterator* it, const qint16* buf, qint32 len)
{
if (m_log2Decim == 0) {
m_decimators_16.decimate1(it, buf, len);