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.
 
 
 
 
 
 

58 lines
881 B

// Copyright 2015-2020 Mobilinkd LLC.
#pragma once
#include "Filter.h"
#include <array>
#include <cstddef>
namespace modemm17
{
template <size_t N>
struct BaseFirFilter : FilterBase<float>
{
BaseFirFilter(const std::array<float, N>& taps)
: taps_(taps)
{
history_.fill(0.0);
}
float operator()(float input) override
{
history_[pos_++] = input;
if (pos_ == N) pos_ = 0;
float result = 0.0;
size_t index = pos_;
for (size_t i = 0; i != N; ++i)
{
index = (index != 0 ? index - 1 : N - 1);
result += history_.at(index) * taps_.at(i);
}
return result;
}
void reset()
{
history_.fill(0.0);
pos_ = 0;
}
private:
const std::array<float, N>& taps_;
std::array<float, N> history_;
size_t pos_ = 0;
};
template <size_t N>
BaseFirFilter<N> makeFirFilter(const std::array<float, N>& taps)
{
return BaseFirFilter<N>(taps);
}
} // modemm17