Поиск частоты сигнала?

это уже пропущенные данные через фильтр калмана, но будет реализован фильтр низких частот, нужная мне частота находится в пределах 11-13 ГЦ

Славка: ну тогда ведь даже постоянную составляющую не нужно отсеивать, ищете два локальных максимума в пределах 1/5 -- 1/20 секунды и находите временной период между ними, тем самым получая период. А 1/период=частота. Максимумы советую искать следующим образом, берете отрезок размером 1/5 сек., находите минимум и по обе стороны от минимума находите максимумы, причем поиск максимумов нужно продолжать, пока или производная не изменит свой знак(при том сама она должна изменяться немного инерционно, для устойчивости к ошибкам) или пока вы не дойдете до точки, всего на 0,2*(max-min) отличающейся от первого минимума - это для случая, когда не нужно избавляться от постоянной составляющей. Очень грубо с точки зрения алгоритмов, но никаких Фурье-преобразований, очень просто и достаточно надежно.