А вот у меня не получается

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