carriersmoothing_algotest.m

载波平滑仿真程序,用matlab编写 经验证十分有效果

% Carrier Smoothing algos Tests
% -------------------------------------------------------------------------
%   Title   : CarrierSmoothing_AlgoTest.m
%   Project : GPS & Galieo receiver realization
%             Laboratoire de communication et d'int間ration
%             de la micro閘ectronique (LACIME)
%             蒫ole de Technologie Sup閞ieure (蒚S)
%             Montr閍l, Qu閎ec
%
%   Author  : Jean-Christophe Guay
%   Date    : 13/02/2009
%
%   Description :
%
%
% -------------------------------------------------------------------------
%   modification history :
% -------------------------------------------------------------------------
%  Version  Mod. Date      Author and description
%
% -------------------------------------------------------------------------


%-------------------------------------------------------------------------%
%                           Initialization
%-------------------------------------------------------------------------%
clear all
close all
clc

%-------------------------------------------------------------------------%
%                           GNSS Rx DATA EXTRACTION
%-------------------------------------------------------------------------%
display('PRS log extracion');
[t_prs,pr,pv,adr] = prslog('prs.dat');
display('Channels log extracion');
[t_chan,Nav,Sync,CPU,PRN,C_N0,Lvl,Fail,Lock,Bad,Health,tval,SVt,SVw] = channstatlog('chan_stat.dat');

%-------------------------------------------------------------------------%
%                           CARRIER SMOOTHING
%-------------------------------------------------------------------------%


[Epoch_Number,Channel_Number] = size(adr);

pr_projected = zeros(Channel_Number);
CS_weigth = 100*zeros(Channel_Number);
pr_smoothed = zeros(Epoch_Number,Channel_Number);


%************************
%Carrier smoothing Algo 1
%************************

%Check if channel track the same satellites without any CycleSlip
for epoch=2:Epoch_Number
    for chan=1:Channel_Number
        if((PRN(floor(mod(epoch,4)+1),chan) == PRN(floor(mod(epoch,4)+1),chan)) && (pr(epoch,chan)-pr(epoch-1,chan)) < 1000)
           
            pr_projected(chan) = pr_smoothed(epoch-1,chan) + adr(epoch,chan)-adr(epoch-1,chan);
            weigth = CS_weigth(chan)/100;
            pr_smoothed(epoch,chan) = weigth * pr(epoch,chan) + (1-weigth) * pr_projected(chan);
            if CS_weigth(chan) > 10
                CS_weigth(chan) = CS_weigth(chan) - 1;
            end

        else
           CS_weigth(chan) = 100;
           pr_smoothed(epoch,chan) = pr(epoch,chan);
        end
    end
end


figure(1)
plot(diff(pr(1000:end,2)))
hold on
plot(diff(pr_smoothed(1000:end,2)),'r')

figure(2)
plot((pr(1000:end,2)))
hold on
plot((pr_smoothed(1000:end,2)),'r')

figure(3)
plot((pr(1000:end,2))-(pr_smoothed(1000:end,2)))