mirror of
https://github.com/f4exb/sdrangel.git
synced 2024-11-05 08:21:16 -05:00
41 lines
840 B
C++
41 lines
840 B
C++
// Copyright 2020 Mobilinkd LLC.
|
|
|
|
#pragma once
|
|
|
|
#include "IirFilter.h"
|
|
|
|
#include <array>
|
|
#include <algorithm>
|
|
#include <numeric>
|
|
#include <cmath>
|
|
#include <tuple>
|
|
|
|
namespace mobilinkd
|
|
{
|
|
|
|
struct CarrierDetect
|
|
{
|
|
using result_t = std::tuple<bool, float>;
|
|
|
|
BaseIirFilter<3> filter_;
|
|
float lock_;
|
|
float unlock_;
|
|
bool locked_ = false;
|
|
|
|
CarrierDetect(std::array<float, 3> const& b, std::array<float, 3> const& a, float lock_level, float unlock_level)
|
|
: filter_(b, a), lock_(lock_level), unlock_(unlock_level)
|
|
{
|
|
}
|
|
|
|
result_t operator()(float 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
|