VE7UWU/sdrangel
1
0
Fork 0
mirror of https://github.com/f4exb/sdrangel.git synced 2025-07-31 05:02:24 -04:00
Code Issues Projects Releases Wiki Activity

Start detecting.

Browse Source
This commit is contained in:
John Greb 2015-01-12 19:59:45 +00:00
parent dde49f8650
commit 1e77911e9c
3 changed files with 32 additions and 5 deletions
Show Stats Download Patch File Download Diff File Expand all files Collapse all files

33
plugins/channel/lora/lorademod.cpp
View File

@ -35,6 +35,7 @@ LoRaDemod::LoRaDemod(SampleSink* sampleSink) :
m_chirp = 0;
m_angle = 0;
m_bin = 0;
loraFilter = new sfft(LORA_SFFT_LEN);
}
@ -51,10 +52,32 @@ void LoRaDemod::configure(MessageQueue* messageQueue, Real Bandwidth)
cmd->submit(messageQueue, this);
}
int LoRaDemod::detect(Complex c)
{
int i, result;
Real peak, mag;
cmplx bins[LORA_SFFT_LEN];
// TODO: don`t need per-sample sliding FFT time resolution
loraFilter->run(c, bins);
peak = mag = 0;
result = 0;
for (i = 0; i < LORA_SFFT_LEN; i++) {
mag = bins[i].real() * bins[i].real()
+ bins[i].imag() * bins[i].imag();
if (mag > peak) {
peak = mag;
result = i;
}
}
return result;
}
void LoRaDemod::feed(SampleVector::const_iterator begin, SampleVector::const_iterator end, bool pO)
{
int newangle;
Complex ci;
cmplx bins[LORA_SFFT_LEN];
m_sampleBuffer.clear();
for(SampleVector::const_iterator it = begin; it < end; ++it) {
Complex c(it->real() / 32768.0, it->imag() / 32768.0);
@ -64,9 +87,11 @@ void LoRaDemod::feed(SampleVector::const_iterator begin, SampleVector::const_ite
m_chirp = (m_chirp + 1) & (SPREADFACTOR - 1);
m_angle = (m_angle + m_chirp) & (SPREADFACTOR - 1);
Complex cangle(cos(M_PI*2*m_angle/SPREADFACTOR),-sin(M_PI*2*m_angle/SPREADFACTOR));
ci *= cangle;
loraFilter->run(ci, bins);
m_sampleBuffer.push_back(Sample(ci.real() * 32000, ci.imag() * 32000));
newangle = detect(ci * cangle);
m_bin = (m_bin + newangle) & (LORA_SFFT_LEN - 1);
Complex nangle(cos(M_PI*2*m_bin/LORA_SFFT_LEN),sin(M_PI*2*m_bin/LORA_SFFT_LEN));
m_sampleBuffer.push_back(Sample(nangle.real() * 1000, nangle.imag() * 1000));
m_sampleDistanceRemain += (Real)m_sampleRate / m_Bandwidth;
}
}

2
plugins/channel/lora/lorademod.h
View File

@ -38,6 +38,7 @@ public:
void configure(MessageQueue* messageQueue, Real Bandwidth);
void feed(SampleVector::const_iterator begin, SampleVector::const_iterator end, bool pO);
int detect(Complex c);
void start();
void stop();
bool handleMessage(Message* cmd);
@ -69,6 +70,7 @@ private:
int m_frequency;
int m_chirp;
int m_angle;
int m_bin;
sfft* loraFilter;

2
sdrbase/dsp/fftfilt.cxx
View File

@ -240,6 +240,6 @@ void sfft::run(const cmplx& input, cmplx *result)
*end = vrot_bins + last ;
itr != end ;
++itr, result++ ) {
*result = itr->bins = itr->bins * itr->vrot + z * itr->vrot;
*result = itr->bins = (itr->bins + z) * itr->vrot;
}
}