mirror of
https://github.com/f4exb/sdrangel.git
synced 2024-11-03 23:41:16 -05:00
42 lines
917 B
C
42 lines
917 B
C
|
// Copyright 2020 Mobilinkd LLC.
|
||
|
|
|
||
|
|
#pragma once
|
||
|
|
|
||
|
|
#include "IirFilter.h"
|
||
|
|
|
||
|
|
#include <array>
|
||
|
|
#include <algorithm>
|
||
|
|
#include <numeric>
|
||
|
|
#include <cmath>
|
||
|
|
#include <tuple>
|
||
|
|
|
||
|
|
namespace mobilinkd
|
||
|
|
{
|
||
|
|
|
||
|
|
template <typename FloatType>
|
||
|
|
struct CarrierDetect
|
||
|
|
{
|
||
|
|
using result_t = std::tuple<bool, FloatType>;
|
||
|
|
|
||
|
|
BaseIirFilter<FloatType, 3> filter_;
|
||
|
|
FloatType lock_;
|
||
|
|
FloatType unlock_;
|
||
|
|
bool locked_ = false;
|
||
|
|
|
||
|
|
CarrierDetect(std::array<FloatType, 3> const& b, std::array<FloatType, 3> const& a, FloatType lock_level, FloatType unlock_level)
|
||
|
|
: filter_(b, a), lock_(lock_level), unlock_(unlock_level)
|
||
|
|
{
|
||
|
|
}
|
||
|
|
|
||
|
|
result_t operator()(FloatType value)
|
||
|
|
{
|
||
|
|
auto filtered = filter_(std::abs(value));
|
||
|
|
if (locked_ && (filtered > unlock_)) locked_ = false;
|
||
|
|
else if (!locked_ && (filtered < lock_)) locked_ = true;
|
||
|
|
|
||
|
|
return std::make_tuple(locked_, filtered);
|
||
|
|
}
|
||
|
|
};
|
||
|
|
|
||
|
|
} // mobilinkd
|