У меня коррелятор не работает., Хелп, плз. Опции

[Alexey_N]

Господа, я пытаюсь сделать обнаружитель гармонического сигнала в его смеси с шумом. По-моему это - классическая постановка, и все давно это уже умеют.
А вот у меня не получается .
Беру входную смесь с шумом (массив чисел) и умножаю её на синус и на косинус той же частоты, что и сигнал (тоже массивы чисел). Полученные два массива почленно возвожу в квадрат, суммирую и беру корень из суммы. Полученный результат накапливаю, ну типа сложением...
Ожидаю, что в процессе обработки массивов на выходе значение будет нарастать. Так и есть, нарастает, но при этом не зависит от частоты входного сигнала. Ну то есть совпадает частота коррелятора со входным сигналом или нет, на выходе нарастающая пила одинакова.
Вопрос - я что-то не так делаю?
Или просто дикая ошибка где-то?
Спасибо.

[petrov]

После умножения на комплексную синусоиду накопить и только потом модуль вычислять.

[Alexey_N]

После умножения на комплексную синусоиду накопить и только потом модуль вычислять.

Я делаю:
Вход = Сигнал + Шум
(Вход*Синус)^2 + (Вход*Косинус)^2 = Сумма
Результат = Результат + (Сумма)^0.5

В каком месте нужен модуль?

А просто FFT нельзя сделать?

FFT работает, без проблем.
Но мне нужен именно коррелятор! Вот тот самый, - из старинных советских учебников, именно он почему-то не выходит...