Взял готовое по ссылке. Сделал тестовый масив синусоид, для проверки полосы и прогнал в симуляторе Иара. Вроде считает, ну и сразу в прибор загнал. Работает и сигналы после фильтра похожий на ожидаемый. Мега 32 тянет два фвч 3 порядка. Количество выборок 500. Полоса 2,4,8Гц.