Синхронизация методом передискретизации, Фильтры Фарроу, ФАПЧ Опции

[ToR_TDA]

Здравствуйте, форумчане!
Есть синусоидальный сигнал частотой 125кГц, который цифруется с частотой 2МГц. Необходимо петлей ФАПЧ засинхронизировать отсчеты при условии возможной отстройки частоты на 100Гц и случайной начальной фазе. Использую фильтр Фарроу, моделирую в Матлабе. Опираюсь на модели Petrova и ссылку Synchronization
Прикрепляю две модели: первая "farrow_2" основана на моделях Petrova и дает положительный результат, вторая "farrow_pll_2" основана на ссылке выше и отказывается работать.
В чем ошибка(и) во второй модели?
P.S. В моделях частота синусоиды 125,1 кГц. Алгоритм будет писаться для DSP.

Прикрепленные файлы

 Farrow.rar ( 18.48 килобайт ) Кол-во скачиваний: 55

 

[ToR_TDA]

Люди добрые, посмотрите, пожалуйста, алгоритм по которому пишу ФАПЧ на DSP. Составлен по моделям товарища petrov. Может, я уже на этом этапе ошибаюсь.

Код

// N - samples/symbol
NCO = 0;
mu = 0;
v  = 0;
One_SPS = 0;
TEDBuff(3) = 0;
TEDBuff(2) = 0;
TEDBuff(1) = 0;
///////////ЦИКЛ//////////
if NCO < 0
    underflow = 1;
else
    underflow = 0;
end
if underflow == 1
    TEDBuff(3) = TEDBuff(2);
    TEDBuff(2) = TEDBuff(1);
    TEDBuff(1) = Out_Farrow;
    mu = NCO;            // for Farrow interpolator
    One_SPS = not One_SPS;

        if One_SPS == 1
            e = TEDBuff(2) * (TEDBuff(3) - TEDBuff(1));     // Gardner TED
            vp = K1*e;                     // proportional component of loop filter
            vi = vi + K2*e;                  // integrator component of loop filter
            v = vp + vi;                     // loop filter output
    end
end
// update registers
W = v + 1;
NCO = NCO mod 4 - W;