1
0
mirror of https://github.com/f4exb/sdrangel.git synced 2026-06-01 21:54:55 -04:00

USRPOutput: Fix corruption when interpolation >= 16.

This commit is contained in:
Jon Beniston
2026-04-22 19:13:03 +01:00
parent a4462cfa40
commit b9461188d1
2 changed files with 27 additions and 31 deletions
@@ -1,6 +1,6 @@
///////////////////////////////////////////////////////////////////////////////////
// Copyright (C) 2017-2020 Edouard Griffiths, F4EXB <f4exb06@gmail.com> //
// Copyright (C) 2020 Jon Beniston, M7RCE <jon@beniston.com> //
// Copyright (C) 2020-26 Jon Beniston, M7RCE <jon@beniston.com> //
// //
// 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 //
@@ -28,14 +28,17 @@
USRPOutputThread::USRPOutputThread(uhd::tx_streamer::sptr stream, size_t bufSamples, SampleSourceFifo* sampleFifo, QObject* parent) :
QThread(parent),
m_running(false),
m_packets(0),
m_underflows(0),
m_droppedPackets(0),
m_stream(stream),
m_bufSamples(bufSamples),
m_sampleFifo(sampleFifo),
m_log2Interp(0)
{
// *2 as samples are I+Q
m_buf = new qint16[2*bufSamples];
std::fill(m_buf, m_buf + 2*bufSamples, 0);
m_buf = new qint16[2 * bufSamples];
std::fill(m_buf, m_buf + 2 * bufSamples, 0);
}
USRPOutputThread::~USRPOutputThread()
@@ -55,8 +58,9 @@ void USRPOutputThread::startWork()
m_startWaitMutex.lock();
start();
while(!m_running)
while (!m_running) {
m_startWaiter.wait(&m_startWaitMutex, 100);
}
m_startWaitMutex.unlock();
}
@@ -100,15 +104,14 @@ void USRPOutputThread::run()
while (m_running)
{
callback(m_buf, m_bufSamples);
qint32 writtenSamples = callback(m_buf, m_bufSamples);
try
{
const size_t samples_sent = m_stream->send(m_buf, m_bufSamples, md);
const size_t sentSamples = m_stream->send(m_buf, writtenSamples, md);
m_packets++;
if (samples_sent != m_bufSamples)
{
qDebug("USRPOutputThread::run written %ld/%ld samples", samples_sent, m_bufSamples);
if (sentSamples != writtenSamples) {
qDebug("USRPOutputThread::run sent %ld/%ld samples", sentSamples, writtenSamples);
}
}
catch (std::exception& e)
@@ -120,17 +123,14 @@ void USRPOutputThread::run()
m_running = false;
}
// Interpolate according to specified log2 (ex: log2=4 => decim=16)
void USRPOutputThread::callback(qint16* buf, qint32 len)
// Interpolate according to specified log2 (ex: log2=4 => interpolate=16)
// Returns the number of samples written to buf, which may be less than len, when the TX buffer is not divisible by the interpolation factor.
qint32 USRPOutputThread::callback(qint16* buf, qint32 len)
{
// Keep signed length to match callback interfaces used by other output threads.
if (len <= 0) {
return;
}
const unsigned int interpolationFactor = 1U << m_log2Interp;
SampleVector& data = m_sampleFifo->getData();
unsigned int iPart1Begin, iPart1End, iPart2Begin, iPart2End;
// Truncation is intentional here: reading more would overrun the fixed TX buffer when len is not divisible by interpolation factor.
m_sampleFifo->read(static_cast<unsigned int>(len)/interpolationFactor, iPart1Begin, iPart1End, iPart2Begin, iPart2End);
@@ -138,25 +138,19 @@ void USRPOutputThread::callback(qint16* buf, qint32 len)
callbackPart(buf, data, iPart1Begin, iPart1End);
}
unsigned int shift = (iPart1End - iPart1Begin)*interpolationFactor;
const unsigned int shift = (iPart1End - iPart1Begin) * interpolationFactor;
if (iPart2Begin != iPart2End) {
callbackPart(buf + 2*shift, data, iPart2Begin, iPart2End);
callbackPart(buf + 2 * shift, data, iPart2Begin, iPart2End);
}
const unsigned int writtenSamples =
((iPart1End - iPart1Begin) + (iPart2End - iPart2Begin)) * interpolationFactor;
if (writtenSamples < static_cast<unsigned int>(len))
{
std::fill(buf + 2*writtenSamples, buf + 2*len, 0);
}
return ((iPart1End - iPart1Begin) + (iPart2End - iPart2Begin)) * interpolationFactor;
}
void USRPOutputThread::callbackPart(qint16* buf, SampleVector& data, unsigned int iBegin, unsigned int iEnd)
{
SampleVector::iterator beginRead = data.begin() + iBegin;
int len = 2*(iEnd - iBegin)*(1<<m_log2Interp);
const int len = 2 * (iEnd - iBegin) * (1 << m_log2Interp);
if (m_log2Interp == 0)
{
@@ -196,12 +190,14 @@ void USRPOutputThread::getStreamStatus(bool& active, quint32& underflows, quint3
if (m_stream->recv_async_msg(md))
{
if ((md.event_code == uhd::async_metadata_t::event_code_t::EVENT_CODE_UNDERFLOW)
|| (md.event_code == uhd::async_metadata_t::event_code_t::EVENT_CODE_UNDERFLOW_IN_PACKET))
if ((md.event_code & uhd::async_metadata_t::event_code_t::EVENT_CODE_UNDERFLOW)
|| (md.event_code & uhd::async_metadata_t::event_code_t::EVENT_CODE_UNDERFLOW_IN_PACKET)) {
m_underflows++;
if ((md.event_code == uhd::async_metadata_t::event_code_t::EVENT_CODE_SEQ_ERROR)
|| (md.event_code == uhd::async_metadata_t::event_code_t::EVENT_CODE_SEQ_ERROR_IN_BURST))
}
if ((md.event_code & uhd::async_metadata_t::event_code_t::EVENT_CODE_SEQ_ERROR)
|| (md.event_code & uhd::async_metadata_t::event_code_t::EVENT_CODE_SEQ_ERROR_IN_BURST)) {
m_droppedPackets++;
}
}
//qDebug() << "USRPOutputThread::getStreamStatus " << m_packets << " " << m_underflows << " " << m_droppedPackets;
active = m_packets > 0;