Fixed slow waterfall with low sample rates

AlexandreRouma · Jul 20, 2020 · f5d6e60 · f5d6e60
1 parent ed49ad6
commit f5d6e60
Show file tree

Hide file tree

Showing 2 changed files with 15 additions and 9 deletions.
diff --git a/src/dsp/resampling.h b/src/dsp/resampling.h
@@ -148,9 +148,6 @@ namespace dsp {
             if (running) {
                 return;
             }
-            if (blockSize < 1 ) {
-                return;
-            }
             _blockSize = blockSize;
             output.setMaxLatency(blockSize * 2);
         }
@@ -159,9 +156,6 @@ namespace dsp {
             if (running) {
                 return;
             }
-            if (skip < 0 ) {
-                skip = 0;
-            }
             _skip = skip;
         }
 
@@ -170,9 +164,20 @@ namespace dsp {
     private:
         static void _worker(BlockDecimator* _this) {
             complex_t* buf = new complex_t[_this->_blockSize];
+            bool delay = _this->_skip < 0;
+
+            int readCount = std::min<int>(_this->_blockSize + _this->_skip, _this->_blockSize);
+            int skip = std::max<int>(_this->_skip, 0);
+            int delaySize = (-_this->_skip) * sizeof(complex_t);
+
+            complex_t* start = &buf[std::max<int>(-_this->_skip, 0)];
+            complex_t* delayStart = &buf[_this->_blockSize + _this->_skip];
+
             while (true) {
-                int read = _this->_input->readAndSkip(buf, _this->_blockSize, _this->_skip);
-                if (read < 0) { break; };
+                if (delay) {
+                    memmove(buf, delayStart, delaySize);
+                }
+                if (_this->_input->readAndSkip(start, readCount, skip) < 0) { break; };
                 if (_this->output.write(buf, _this->_blockSize) < 0) { break; };
             }
             delete[] buf;

diff --git a/src/signal_path.cpp b/src/signal_path.cpp
@@ -46,7 +46,8 @@ void SignalPath::setSampleRate(float sampleRate) {
 
     dcBiasRemover.setBlockSize(inputBlockSize);
     split.setBlockSize(inputBlockSize);
-    fftBlockDec.setSkip((sampleRate / fftRate) - fftSize);
+    int skip = (sampleRate / fftRate) - fftSize;
+    fftBlockDec.setSkip(skip);
     mainVFO.setInputSampleRate(sampleRate, inputBlockSize);
 
     // // Reset the modulator and audio systems