// 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