codeloopfilter.m

GPS的CA码捕获跟踪源代码

function [CodeErr] = CodeLoopFilter(w,a,theta_code,theta_code_old,CodeErr_old)

T = 1*(10^(-3));
%w = 20;   %自然圆频率
%a= 2; %阻尼系数
%CodeDamp = 1;

CodeErr = CodeErr_old+(T*(w^2)+a*w)*theta_code-(a*w)*theta_code_old;
%offside = offside_old+T*CodeErr; % 积分环节（NCO输出相位）