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