MATLAB编程伽利略和北斗的BOC捕获跟踪和解算程序 - matlab算法设计

下载频道> 资源分类> matlab源码> 算法设计> MATLAB编程伽利略和北斗的BOC捕获跟踪和解算程序

标题：MATLAB编程伽利略和北斗的BOC捕获跟踪和解算程序
分享到：

所属分类: 算法设计资源类型：程序源码文件大小: 1.06 MB 上传时间: 2019-12-01 22:07:10 下载次数: 3 资源积分：1分提供者: jiqiren 20191201100758627

内容：
classdef BitSynchronization < Signal

properties (SetAccess = private)

SVID;

SecondaryPRNCodeObjs;

CorrelatorOutBuffer;

FrequencyShiftBuffer;

CarrierPhaseShiftBuffer;

TimeShiftBuffer;

CorrelatorOutBufferSize;

NumberOfCorrelatorOutInBuffer;

BitSoftInformationFileName;

BitSoftInformationFile;

Replica;

ProbabilityOfFalseAlarm;

SufficientStatistics;

Threshold;

end % end of properties

properties (SetAccess = private, GetAccess = private)

checkBitSynchronizationHandle;

end % end of properties

methods

function obj = BitSynchronization(Name, SVID, BitSoftInformationFileName)

obj = obj@Signal(Name);

obj.SVID = SVID;

obj.BitSoftInformationFileName = BitSoftInformationFileName;

obj.BitSoftInformationFile = fopen(obj.BitSoftInformationFileName, 'w');

obj.NumberOfCorrelatorOutInBuffer = 0;

obj.ProbabilityOfFalseAlarm = 1e-9;

SVID = obj.SVID;

switch (obj.Name)

case 'E5'

obj.CorrelatorOutBufferSize = 100;

N = obj.CorrelatorOutBufferSize;

obj.SecondaryPRNCodeObjs{1} = SecondaryPRNCode('E5aI');

obj.SecondaryPRNCodeObjs{2} = SecondaryPRNCode('E5aQ');

obj.SecondaryPRNCodeObjs{3} = SecondaryPRNCode('E5bI');

obj.SecondaryPRNCodeObjs{4} = SecondaryPRNCode('E5bQ');

obj.Replica(1,:) = BitSynchronization.extendCode(...

obj.SecondaryPRNCodeObjs{1}.getCode(1, 0), N);

obj.Replica(2,:) = BitSynchronization.extendCode(...

obj.SecondaryPRNCodeObjs{2}.getCode(SVID, 0), N);

obj.Replica(3,:) = BitSynchronization.extendCode(...

obj.SecondaryPRNCodeObjs{3}.getCode(1, 0), N);

obj.Replica(4,:) = BitSynchronization.extendCode(...

obj.SecondaryPRNCodeObjs{4}.getCode(SVID, 0), N);

obj.Threshold = zeros(1, 4);

obj.SufficientStatistics = zeros(1, 4);

obj.checkBitSynchronizationHandle = @obj.checkBitSynchronizationE5;

case 'E5a'

obj.CorrelatorOutBufferSize = 100;

N = obj.CorrelatorOutBufferSize;

obj.SecondaryPRNCodeObjs{1} = SecondaryPRNCode('E5aI');

obj.SecondaryPRNCodeObjs{2} = SecondaryPRNCode('E5aQ');

obj.Replica(1,:) = BitSynchronization.extendCode(...

obj.SecondaryPRNCodeObjs{1}.getCode(1, 0), N);

obj.Replica(2,:) = BitSynchronization.extendCode(...

obj.SecondaryPRNCodeObjs{2}.getCode(SVID, 0), N);

obj.Threshold = zeros(1, 2);

obj.SufficientStatistics = zeros(1, 2);

obj.checkBitSynchronizationHandle = @obj.checkBitSynchronizationE5a;

case 'E5aI'

obj.CorrelatorOutBufferSize = 100;

N = obj.CorrelatorOutBufferSize;

obj.SecondaryPRNCodeObjs{1} = SecondaryPRNCode('E5aI');

obj.Replica(1,:) = BitSynchronization.extendCode(...

obj.SecondaryPRNCodeObjs{1}.getCode(1, 0), N);

obj.Threshold = zeros(1, 1);

obj.SufficientStatistics = zeros(1, 1);

obj.checkBitSynchronizationHandle = @obj.checkBitSynchronizationE5aI;

case 'E5aQ'

obj.CorrelatorOutBufferSize = 100;

N = obj.CorrelatorOutBufferSize;

obj.SecondaryPRNCodeObjs{1} = SecondaryPRNCode('E5aQ');

obj.Replica(1,:) = BitSynchronization.extendCode(...

obj.SecondaryPRNCodeObjs{1}.getCode(SVID, 0), N);

obj.Threshold = zeros(1, 1);

obj.SufficientStatistics = zeros(1, 1);

obj.checkBitSynchronizationHandle = @obj.checkBitSynchronizationE5aQ;

case 'E5b'

obj.CorrelatorOutBufferSize = 100;

N = obj.CorrelatorOutBufferSize;

obj.SecondaryPRNCodeObjs{1} = SecondaryPRNCode('E5bI');

obj.SecondaryPRNCodeObjs{2} = SecondaryPRNCode('E5bQ');

obj.Replica(1,:) = BitSynchronization.extendCode(...

obj.SecondaryPRNCodeObjs{1}.getCode(1, 0), N);

obj.Replica(2,:) = BitSynchronization.extendCode(...

obj.SecondaryPRNCodeObjs{2}.getCode(SVID, 0), N);

obj.Threshold = zeros(1, 2);

obj.SufficientStatistics = zeros(1, 2);

obj.checkBitSynchronizationHandle = @obj.checkBitSynchronizationE5b;

case 'E5bI'

obj.CorrelatorOutBufferSize = 100;

N = obj.CorrelatorOutBufferSize;

obj.SecondaryPRNCodeObjs{1} = SecondaryPRNCode('E5bI');

obj.Replica(1,:) = BitSynchronization.extendCode(...

obj.SecondaryPRNCodeObjs{1}.getCode(1, 0), N);

obj.Threshold = zeros(1, 1);

obj.SufficientStatistics = zeros(1, 1);

obj.checkBitSynchronizationHandle = @obj.checkBitSynchronizationE5bI;

case 'E5bQ'

obj.CorrelatorOutBufferSize = 100;

N = obj.CorrelatorOutBufferSize;

obj.SecondaryPRNCodeObjs{1} = SecondaryPRNCode('E5bQ');

obj.Replica(1,:) = BitSynchronization.extendCode(...

obj.SecondaryPRNCodeObjs{1}.getCode(SVID, 0), N);

obj.Threshold = zeros(1, 1);

obj.SufficientStatistics = zeros(1, 1);

obj.checkBitSynchronizationHandle = @obj.checkBitSynchronizationE5bQ;

case 'E1'

obj.CorrelatorOutBufferSize = 25;

N = obj.CorrelatorOutBufferSize;

obj.SecondaryPRNCodeObjs{1} = [];

obj.SecondaryPRNCodeObjs{2} = SecondaryPRNCode('E1c');

obj.Replica(1,:) = ones(1, N);

obj.Replica(2,:) = BitSynchronization.extendCode(...

obj.SecondaryPRNCodeObjs{2}.getCode(1, 0), N);

obj.Threshold = zeros(1, 2);

obj.SufficientStatistics = zeros(1, 2);

obj.checkBitSynchronizationHandle = @obj.checkBitSynchronizationE1;

case 'E1c'

obj.CorrelatorOutBufferSize = 25;

N = obj.CorrelatorOutBufferSize;

obj.SecondaryPRNCodeObjs{1} = SecondaryPRNCode('E1c');

obj.Replica(1,:) = BitSynchronization.extendCode(...

obj.SecondaryPRNCodeObjs{1}.getCode(1, 0), N);

obj.Threshold = zeros(1, 1);

obj.SufficientStatistics = zeros(1, 1);

obj.checkBitSynchronizationHandle = @obj.checkBitSynchronizationE1c;

case 'B1'

obj.CorrelatorOutBufferSize = 100;

obj.SecondaryPRNCodeObjs{1} = SecondaryPRNCode('B1');

N = obj.CorrelatorOutBufferSize;

obj.Replica(1,:) = BitSynchronization.extendCode(...

obj.SecondaryPRNCodeObjs{1}.getCode(1, 0), N);

obj.Threshold = zeros(1, 1);

obj.SufficientStatistics = zeros(1, 1);

obj.checkBitSynchronizationHandle = @obj.checkBitSynchronizationB1;

otherwise

error('Unknown signal')

end

function obj = set.CorrelatorOutBufferSize(obj, val)

obj.CorrelatorOutBufferSize = val;

obj.TimeShiftBuffer = zeros(1, obj.CorrelatorOutBufferSize);

obj.FrequencyShiftBuffer = zeros(1, obj.CorrelatorOutBufferSize);

obj.CarrierPhaseShiftBuffer = zeros(1, obj.CorrelatorOutBufferSize);

switch (obj.Name)

case 'E5'

obj.CorrelatorOutBuffer = zeros(4, obj.CorrelatorOutBufferSize);

case 'E5a'

obj.CorrelatorOutBuffer = zeros(2, obj.CorrelatorOutBufferSize);

case 'E5aI'

obj.CorrelatorOutBuffer = zeros(1, obj.CorrelatorOutBufferSize);

case 'E5aQ'

obj.CorrelatorOutBuffer = zeros(1, obj.CorrelatorOutBufferSize);

case 'E5b'

obj.CorrelatorOutBuffer = zeros(2, obj.CorrelatorOutBufferSize);

case 'E5bI'

obj.CorrelatorOutBuffer = zeros(1, obj.CorrelatorOutBufferSize);

case 'E5bQ'

obj.CorrelatorOutBuffer = zeros(1, obj.CorrelatorOutBufferSize);

case 'E1'

obj.CorrelatorOutBuffer = zeros(2, obj.CorrelatorOutBufferSize);

case 'E1c'

obj.CorrelatorOutBuffer = zeros(1, obj.CorrelatorOutBufferSize);

case 'B1'

obj.CorrelatorOutBuffer = zeros(1, obj.CorrelatorOutBufferSize);

otherwise

error('Unknown signal')

end

function obj = addToBuffer(obj, CorrelatorOut, FrequencyShift, ...

TimeShift, CarrierPhaseShift)

if (obj.NumberOfCorrelatorOutInBuffer < obj.CorrelatorOutBufferSize)

obj.NumberOfCorrelatorOutInBuffer = obj.NumberOfCorrelatorOutInBuffer+1;

i = obj.NumberOfCorrelatorOutInBuffer;

else

i = obj.CorrelatorOutBufferSize;

obj.CorrelatorOutBuffer = circshift(obj.CorrelatorOutBuffer.',-1).';

obj.FrequencyShiftBuffer = circshift(obj.FrequencyShiftBuffer.',-1).';

obj.TimeShiftBuffer = circshift(obj.TimeShiftBuffer.',-1).';

obj.CarrierPhaseShiftBuffer =...

circshift(obj.CarrierPhaseShiftBuffer.',-1).';

end

obj.CorrelatorOutBuffer(:, i) = CorrelatorOut;

obj.FrequencyShiftBuffer(:, i) = FrequencyShift;

obj.TimeShiftBuffer(:, i) = TimeShift;

obj.CarrierPhaseShiftBuffer(:, i) = CarrierPhaseShift;

end

function out = getFrequencyShiftStd(obj)

out = obj.getStd(obj.FrequencyShiftBuffer, 2);

end

function out = getTimeShiftStd(obj)

out = obj.getStd(obj.TimeShiftBuffer, 2);

end

function out = getCarrierPhaseShiftStd(obj)

if (sum(obj.CarrierPhaseShiftBuffer == 0) > ...

floor(obj.CorrelatorOutBufferSize/10))

out = Inf;

else

out = obj.getStd(obj.CarrierPhaseShiftBuffer, 2);

end

function out = getStd(obj, Buffer, Degree)

if (obj.NumberOfCorrelatorOutInBuffer ~= obj.CorrelatorOutBufferSize)

error('Not enough correlator out in buffer')

else

x = 1:obj.NumberOfCorrelatorOutInBuffer;

y = Buffer;

[p S] = polyfit(x, y, Degree);

y_interpolated = polyval(p, x);

out = sqrt(var(y - y_interpolated));

end

function out = checkFrequencyTimeShiftStd(obj, FrequencyShiftStdThreshold,...

TimeShiftStdThreshold)

if (obj.NumberOfCorrelatorOutInBuffer ~= obj.CorrelatorOutBufferSize)

error('Not enough correlator out in buffer')

else

if ((obj.getFrequencyShiftStd() < FrequencyShiftStdThreshold) && ...

(obj.getTimeShiftStd() < TimeShiftStdThreshold))

out = 1;

else

out = 0;

end

function out = checkCarrierPhaseShiftStdThreshold(obj,...

CarrierPhaseShiftStdThreshold)

if (obj.NumberOfCorrelatorOutInBuffer ~= obj.CorrelatorOutBufferSize)

error('Not enough correlator out in buffer')

else

if (obj.getCarrierPhaseShiftStd() < CarrierPhaseShiftStdThreshold)

out = 1;

else

out = 0;

end

function out = checkBitSynchronization(obj)

if (obj.NumberOfCorrelatorOutInBuffer ~= obj.CorrelatorOutBufferSize)

error('Not enough correlator out in buffer')

else

out = obj.checkBitSynchronizationHandle();

end

function out = getThreshold(obj, Std)

out = Std * sqrt( -2*log(obj.ProbabilityOfFalseAlarm));

end

function out = getSufficientStatistics(obj, Observation,...

Replica, NumberOfPeriods)

out = 0;

N = NumberOfPeriods;

M = length(Observation)/N;

for i = 1:N

out = out + abs(Observation((1 + (i-1)*M):(i*M)) *...

Replica((1 + (i-1)*M):(i*M)).');

end

function out = Decide(obj, SufficientStatistics, Threshold)

if (SufficientStatistics > Threshold)

out = 1;

else

out = 0;

end

function out = checkBitSynchronizationIndex(obj, Index)

M = obj.CorrelatorOutBufferSize;

N = M/obj.SecondaryPRNCodeObjs{Index}.NumberOfChips;

Std = obj.getStd(obj.CorrelatorOutBuffer(Index,:), 1) * sqrt(M/N) * sqrt(N);

SuffStat = obj.getSufficientStatistics(obj.CorrelatorOutBuffer(Index,:),...

obj.Replica(Index,:), N);

Threshold = obj.getThreshold(Std);

out = obj.Decide(SuffStat, Threshold);

obj.Threshold(Index) = Threshold;

obj.SufficientStatistics(Index) = SuffStat;

end

function out = getBitSoftInformation(obj)

switch (obj.Name)

case 'E5'

for i=1:4

out(i,:) = obj.getBitSoftInformationIndex(i);

end

case 'E5a'

out(1,:) = obj.getBitSoftInformationIndex(1);

%out(2,:) = obj.getBitSoftInformationIndex(2);

case 'E5aI'

out(1,:) = obj.getBitSoftInformationIndex(1);

case 'E5aQ'

%out(1,:) = obj.getBitSoftInformationIndex(1);

case 'E5b'

out(1,:) = obj.getBitSoftInformationIndex(1);

%out(2,:) = obj.getBitSoftInformationIndex(2);

case 'E5bI'

out(1,:) = obj.getBitSoftInformationIndex(1);

case 'E5bQ'

%out(1,:) = obj.getBitSoftInformationIndex(1);

case 'E1'

out(1,:) = obj.getBitSoftInformationIndex(1);

case 'E1c'

%out(1,:) = obj.getBitSoftInformationIndex(1);

case 'B1'

out(1,:) = obj.getBitSoftInformationIndex(1);

otherwise

error('Unknown signal')

end

function obj = storeBitSoftInformation(obj)

SI = obj.getBitSoftInformation();

switch (obj.Name)

case 'E5'

SIToStore(1,:) = SI(1,:);

SIToStore(2,:) = SI(3,:);

case 'E5a'

SIToStore(1,:) = SI(1,:);

case 'E5aI'

SIToStore(1,:) = SI(1,:);

case 'E5aQ'

case 'E5b'

SIToStore(1,:) = SI(1,:);

case 'E5bI'

SIToStore(1,:) = SI(1,:);

case 'E5bQ'

case 'E1'

SIToStore(1,:) = SI(1,:);

case 'E1c'

case 'B1'

SIToStore(1,:) = SI(1,:);

otherwise

error('Unknown signal')

end

[m n] = size(SIToStore);

File = obj.BitSoftInformationFile;

for i=1:n

for k=1:m

fprintf(File, '%f', SIToStore(k, i));

end

fprintf(File, '\n');

end

function out = getBitSoftInformationIndex(obj, Index)

M = obj.CorrelatorOutBufferSize;

try

N = M/obj.SecondaryPRNCodeObjs{Index}.NumberOfChips;

catch

N = M;

end

Observation = obj.CorrelatorOutBuffer(Index,:);

K = M/N;

Replica = obj.Replica(Index, :);

for i = 1:N

tmp(i) = Observation((1 + (i-1)*K):(i*K)) *...

Replica((1 + (i-1)*K):(i*K)).';

end

out = real(tmp(N));

%CarrierPhaseVec = atan(imag(tmp)./real(tmp)); % insensitive to 180 degree

%CarrierPhase = mean(CarrierPhaseVec);

%tmp = tmp .* exp(-j*CarrierPhase);

%out = real(tmp(N));

%CarrierPhaseVec = atan2(imag(tmp), real(tmp)); % insensitive to 180 degree

%angle_old = CarrierPhaseVec(N-1);

%angle_new = CarrierPhaseVec(N);

%out = angle_new - angle_old;

%if (out < (-3*pi/2))

% out = out + 2*pi;

%elseif ( (out >= (-3*pi/2)) && (out < -pi))

% out = out + pi;

%elseif ( (out >= -pi) && (out < (-pi/2)))

% out = out + pi/2;

%elseif ( (out >= -pi/2) && (out < 0))

% out = out + pi/2;

%elseif ( (out >= pi/2) && (out < pi))

% out = out - pi;

%elseif ( (out >= pi) && (out < 3*pi/2))

% out = out - 3*pi/2;

%elseif ( (out >= 3*pi/2) && (out < 2*pi))

% out = out - 3*pi/2;

%end

%tmp2 = tmp(N)/tmp(N-1);

%phi = atan2(imag(tmp2), real(tmp2));

%out = abs(phi) - pi/2;

end

function delete(obj)

if (~isempty(obj.BitSoftInformationFile))

fclose(obj.BitSoftInformationFile);

end

end % end of methods

methods (Access = private)

function out = checkBitSynchronizationE5(obj)

for i=1:4

out(i) = obj.checkBitSynchronizationIndex(i);

end

function out = checkBitSynchronizationE5a(obj)

out(1) = obj.checkBitSynchronizationIndex(1);

out(2) = obj.checkBitSynchronizationIndex(2);

end

function out = checkBitSynchronizationE5aI(obj)

out(1) = obj.checkBitSynchronizationIndex(1);

end

function out = checkBitSynchronizationE5aQ(obj)

out(1) = obj.checkBitSynchronizationIndex(1);

end

function out = checkBitSynchronizationE5b(obj)

out(1) = obj.checkBitSynchronizationIndex(1);

out(2) = obj.checkBitSynchronizationIndex(2);

end

function out = checkBitSynchronizationE5bI(obj)

out(1) = obj.checkBitSynchronizationIndex(1);

end

function out = checkBitSynchronizationE5bQ(obj)

out(1) = obj.checkBitSynchronizationIndex(1);

end

function out = checkBitSynchronizationE1(obj)

out(1) = obj.checkBitSynchronizationIndex(2);

end

function out = checkBitSynchronizationE1c(obj)

out(1) = obj.checkBitSynchronizationIndex(1);

end

function out = checkBitSynchronizationB1(obj)

out(1) = obj.checkBitSynchronizationIndex(1);

end

end % end of methods

methods (Static)

function out = extendCode(Code, NumberOfChips)

CodeLength = length(Code);

NumberOfPeriods = floor(NumberOfChips/CodeLength);

for i=1:NumberOfPeriods

out((1 + (i-1)*CodeLength) : (i*CodeLength) ) = -2*Code +1;

end

if (NumberOfChips > (NumberOfPeriods*CodeLength) )

ChipsToEnd = NumberOfChips -NumberOfPeriods*CodeLength;

out((1 + NumberOfPeriods*CodeLength) : end) = -2*Code(1:ChipsToEnd) +1;

end

end % end of methods

end % end of class

文件列表（点击上边下载按钮，如果是垃圾文件请在下面评价差评或者投诉）:

关键词： MATLAB 编程 伽利略 北斗 BOC 捕获 跟踪 解算 程序

matlab源码下载排行

回到顶部

友情链接

matlab源码网站源码编程语言网络编程手机通讯编程 KUNAG 官网 KUNAG 电商更多

: 联系方式| 版权声明| 招聘信息| 广告服务| 银行汇款| 法律顾问| 兼职技术| 付款方式| 关于我们|; 网站客服程序员兼职招聘 411241577@qq.com; 沪ICP备19040327号-3; 公安备案号：沪公网安备 31011802003874号; 库纳格流体控制系统（上海）有限公司版权所有; Copyright © 1999-2014, GUSUCODE.COM, All Rights Reserved

关键词： MATLAB 编程 伽利略 北斗 BOC 捕获 跟踪 解算 程序

相关推荐

matlab源码下载排行

友情链接

关键词： MATLAB 编程伽利略北斗 BOC 捕获跟踪解算程序