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.
78 lines
2.0 KiB
78 lines
2.0 KiB
// Copyright 2021 Mobilinkd LLC. |
|
|
|
#pragma once |
|
|
|
#include "SlidingDFT.h" |
|
|
|
#include <array> |
|
#include <complex> |
|
#include <cstddef> |
|
|
|
namespace modemm17 { |
|
|
|
/** |
|
* Data carrier detection using the difference of two DFTs, one in-band and |
|
* one out-of-band. The first frequency is the in-band frequency and the |
|
* second one is the out-of-band Frequency. The second frequency must be |
|
* within the normal passband of the receiver, but beyond the normal roll-off |
|
* frequency of the data carrier. |
|
* |
|
* This version uses the NSlidingDFT implementation to reduce the memory |
|
* footprint. |
|
* |
|
* As an example, the cut-off for 4.8k symbol/sec 4-FSK is 2400Hz, so 3000Hz |
|
* is a reasonable out-of-band frequency to use. |
|
* |
|
* Note: the input to this DCD must be unfiltered (raw) baseband input. |
|
*/ |
|
template <size_t SampleRate, size_t Accuracy = 1000> |
|
struct DataCarrierDetect |
|
{ |
|
NSlidingDFT<SampleRate, SampleRate / Accuracy, 2> dft_; |
|
float ltrigger_; |
|
float htrigger_; |
|
float level_1 = 0.0; |
|
float level_2 = 0.0; |
|
float level_ = 0.0; |
|
bool triggered_ = false; |
|
|
|
DataCarrierDetect( |
|
size_t freq1, |
|
size_t freq2, |
|
float ltrigger = 2.0, |
|
float htrigger = 5.0 |
|
) : |
|
dft_({freq1, freq2}), |
|
ltrigger_(ltrigger), |
|
htrigger_(htrigger) |
|
{ |
|
} |
|
|
|
/** |
|
* Accept unfiltered baseband input and output a decision on whether |
|
* a carrier has been detected after every @tparam BlockSize inputs. |
|
*/ |
|
void operator()(float sample) |
|
{ |
|
auto result = dft_(sample); |
|
level_1 += std::norm(result[0]); |
|
level_2 += std::norm(result[1]); |
|
} |
|
|
|
/** |
|
* Update the data carrier detection level. |
|
*/ |
|
void update() |
|
{ |
|
level_ = level_ * 0.8 + 0.2 * (level_1 / level_2); |
|
level_1 = 0.0; |
|
level_2 = 0.0; |
|
triggered_ = triggered_ ? level_ > ltrigger_ : level_ > htrigger_; |
|
} |
|
|
|
|
|
float level() const { return level_; } |
|
bool dcd() const { return triggered_; } |
|
}; |
|
|
|
} // modemm17
|
|
|