-
Notifications
You must be signed in to change notification settings - Fork 45
/
calculatePseudoranges.m
74 lines (66 loc) · 3.22 KB
/
calculatePseudoranges.m
1
2
3
4
5
6
7
8
9
10
11
12
13
14
15
16
17
18
19
20
21
22
23
24
25
26
27
28
29
30
31
32
33
34
35
36
37
38
39
40
41
42
43
44
45
46
47
48
49
50
51
52
53
54
55
56
57
58
59
60
61
62
63
64
65
66
67
68
69
70
71
72
73
74
function [pseudoranges] = calculatePseudoranges(trackResults, ...
msOfTheSignal, ...
channelList, settings)
%calculatePseudoranges finds relative pseudoranges for all satellites
%listed in CHANNELLIST at the specified millisecond of the processed
%signal. The pseudoranges contain unknown receiver clock offset. It can be
%found by the least squares position search procedure.
%
%[pseudoranges] = calculatePseudoranges(trackResults, msOfTheSignal, ...
% channelList, settings)
%
% Inputs:
% trackResults - output from the tracking function
% msOfTheSignal - pseudorange measurement point (millisecond) in
% the trackResults structure
% channelList - list of channels to be processed
% settings - receiver settings
%
% Outputs:
% pseudoranges - relative pseudoranges to the satellites.
%--------------------------------------------------------------------------
% SoftGNSS v3.0
%
% Copyright (C) Darius Plausinaitis
% Written by Darius Plausinaitis
% Based on Peter Rinder and Nicolaj Bertelsen
%--------------------------------------------------------------------------
%
%This program is free software; you can redistribute it and/or
%modify it under the terms of the GNU General Public License
%as published by the Free Software Foundation; either version 2
%of the License, or (at your option) any later version.
%
%This program is distributed in the hope that it will be useful,
%but WITHOUT ANY WARRANTY; without even the implied warranty of
%MERCHANTABILITY or FITNESS FOR A PARTICULAR PURPOSE. See the
%GNU General Public License for more details.
%
%You should have received a copy of the GNU General Public License
%along with this program; if not, write to the Free Software
%Foundation, Inc., 51 Franklin Street, Fifth Floor, Boston, MA 02110-1301,
%USA.
%--------------------------------------------------------------------------
% CVS record:
% $Id: calculatePseudoranges.m,v 1.1.2.18 2006/08/09 17:20:11 dpl Exp $
%--- Set initial travel time to infinity ----------------------------------
% Later in the code a shortest pseudorange will be selected. Therefore
% pseudoranges from non-tracking channels must be the longest - e.g.
% infinite.
travelTime = inf(1, settings.numberOfChannels);
% Find number of samples per spreading code
samplesPerCode = round(settings.samplingFreq / ...
(settings.codeFreqBasis / settings.codeLength));
%--- For all channels in the list ...
for channelNr = channelList
%--- Compute the travel times -----------------------------------------
travelTime(channelNr) = ...
trackResults(channelNr).absoluteSample(msOfTheSignal(channelNr)) / samplesPerCode;
end
%--- Truncate the travelTime and compute pseudoranges ---------------------
minimum = floor(min(travelTime));
travelTime = travelTime - minimum + settings.startOffset;
%--- Convert travel time to a distance ------------------------------------
% The speed of light must be converted from meters per second to meters
% per millisecond.
pseudoranges = travelTime * (settings.c / 1000);