c6_pllsim.m

来自「二阶锁相环 m 文件」· M 代码 · 共 28 行

% file: c6_pllsim.m
w2b = 0; w2c = 0; s5 = 0; phivco = 0; %initialize
twopi = 2*pi;
twofs = 2*fs;
G = 2*pi*fn*(zeta+sqrt(zeta*zeta-lambda));
a = 2*pi*fn/(zeta+sqrt(zeta*zeta-lambda));
a1 = a*(1-lambda); a2 = a*lambda;
phierror = zeros(1,npts);
fvco = zeros(1,npts);
% beginning of simulation loop
for i = 1:npts
    s1 = phin(i) - phivco;
    s2 = sin(s1);
    s3 = G*s2;
    s4 = a2*s3;
    s4a = s4-a2*s5;
    w1b = s4a+w2b;
    w2b = s4a+w1b;
    s5 = w1b/twofs;
    s6 = s3+s5;
    w1c = s6+w2c;
    w2c = s6+w1c;
    phivco = w1c/twofs;
    phierror(i) = s1;
    fvco(i) = s6/twopi;
end
% end of simulation loop freqerror = fin-fvco;
% end of script file.