CN102590835B - GPS/INS tightly integrated tracking loop Gauss code phase discriminator and design method thereof - Google Patents
GPS/INS tightly integrated tracking loop Gauss code phase discriminator and design method thereof Download PDFInfo
- Publication number
- CN102590835B CN102590835B CN 201210051003 CN201210051003A CN102590835B CN 102590835 B CN102590835 B CN 102590835B CN 201210051003 CN201210051003 CN 201210051003 CN 201210051003 A CN201210051003 A CN 201210051003A CN 102590835 B CN102590835 B CN 102590835B
- Authority
- CN
- China
- Prior art keywords
- code phase
- ins
- gps
- discr
- code
- Prior art date
- Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
- Expired - Fee Related
Links
Images
Landscapes
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
The invention provides a GPS/INS tightly integrated tracking loop Gauss code phase discriminator and a design method thereof. Based on the traditional code phase discriminator, the Gauss code phase discriminator of the invention is obtained by adding an INS code phase discriminator module and a Gauss code phase discriminator module. The design method of the Gauss code phase discriminator is characterized in that: instant code phase information generated by a GPS receiver code tracking loop is used by an INS system to establish the INS code phase discriminator which works synchronously; mean square errors of output data of the traditional code phase discriminator and the INS code phase discriminator are served as a weighting coefficient which is used to measure phase demodulation errors of the traditional code phase discriminator and the INS code phase discriminator so as to form the Gauss code phase discriminator, wherein the mean square errors are obtained in real time. According to the invention, a pseudo-random code autocorrelation peak value can be increased. Under multipath interference, a phase demodulation output characteristic can be increased and a code phase tracking error can be effectively reduced.
Description
Technical field
The present invention relates to GNSS (GPS (Global Position System))/INS (inertial navigation system) integrated navigation field, relate in particular to when multipath signal disturbs,, designed the dark combined tracking loop of a kind of GPS/INS Gauss code phase Discr. assisting down of INS information.
Background technology
According to the difference of the satellite receiver data source that information fusion adopted, generally the GPS/INS integrated navigation system is divided into pine combination, tightly combination and dark combination, GPS represents Global Positioning System (GPS), INS represents inertial navigation system.Dark combination has pine combination and tight combination incomparable advantage, it is the current research direction of GPS/INS integrated navigation system, dark combination technique has broken through the working method of the original track loop of satellite receiver, therefore, the redesign of track loop is become the research focus.The code phase Discr. is the key component of code tracking loop (DLL), and it has directly determined the discriminating precision of code phase, influences the code phase tracking error, so the code phase Discr. has influenced noise and the dynamic dispatching important performance of DLL to a great extent.
In DLL, the C/A sign indicating number elder generation that the local code generator produces carries out related operation with the C/A sign indicating number in the received signal, determines code phase error by the code phase Discr. then, and traditional code phase Discr. has:
(a) the incoherent hysteresis amplitude Discr. that subtracts in advance, before being called for short, it subtracts back amplitude Discr., it is more common a kind of code phase Discr. of usefulness, because this Discr. needs to calculate respectively leading, hysteresis auto-correlation amplitude, and these auto-correlation amplitudes all need just can try to achieve through opening radical sign, so calculated amount is bigger than normal, efficiency ratio is lower.For the relevant spacing of 0.5 code element, in ± 0.5 code element error originated from input scope, it produces good tracking error.But after the normalization, for the relevant spacing of 0.5 code element, error originated from input produces good tracking error during less than ± 1.5 code elements, and error originated from input was greater than ± 1.5 o'clock, and its can be because become unstable divided by 0.Owing to only need information leading, two branch roads that lag behind, so need two pairs of correlators to get final product.
(b) the incoherent after-power Discr. that subtracts in advance, it is that the non-coherent integration power on leading branch road and the hysteresis branch road is subtracted each other, this incoherent after-power method that subtracts in advance can be removed out the radical sign computing from, so subtract in advance for incoherent that hysteresis amplitude method calculated amount is little, efficient is high.Yet,, thereby adopt the incoherent after-power Discr. that subtracts in advance can produce certain phase demodulation error because auto-correlation amplitude curve and powertrace do not coincide.As long as to subtract hysteresis amplitude Discr. in advance the same also two pairs of correlators with incoherent, and error performance is also similar.
(c) patibhaga-nimitta is done long-pending power Discr., this code phase Discr. no longer adopts the non-coherent integration result, but the direct coherent integration value of utilizing on leading, instant and three branch roads that lag behind, so it needs three pairs of correlators at least, the needed calculated amount of relevant dot product power method that is adopted is all lower than preceding two kinds of incoherent type Discr.s, for the relevant spacing of 0.5 code element, in ± 0.5 code element error originated from input scope, the real error output of its approximate generation.
(d) relevant dot product power Discr., this Discr. is a kind of special case that patibhaga-nimitta is done long-pending power Discr., promptly when the carrier wave ring adopts the form of phaselocked loop and phaselocked loop to be operated in stable state again, all power of received signal concentrate in the same way on the branch road all, and the signal on the quadrature branch approaches zero.Method that this Discr. adopted is calculated the simplest, yet the power concentration that it requires signal is on branch road in the same way.If carrier wave adopts FLL, if perhaps the phaselocked loop as the carrier wave ring does not also reach stable state, a part of power of received signal can run off in quadrature branch so, and the signal power of exporting on this feasible branch road does not in the same way reach maximum, thereby causes this Discr. performance decrease.
When carrier is done motion in the good environment of signal, traditional phase detector can both be finished phase discrimination function, but under multipath disturbs, code phase is followed the tracks of and has been subjected to having a strong impact on of undesired signal, these code phase Discr.s can not identify code phase error in real time, and then track loop will enter out-of-lock condition.Therefore, many scholars have proposed a series of anti-multipath algorithm of interference based on the code phase Discr., mainly contain multipath separation method and narrow correlation technique method based on maximal possibility estimation.Yet, poor based on the noise robustness of the multipath separation method of maximal possibility estimation, promptly can estimate very exactly the amplitude and the phase place of multipath undesired signal under the situation of noise not having, and the accuracy of its estimation descends greatly when having noise.There is its intrinsic limitation in narrow correlation technique: because related interval can not be 0, therefore adopting narrow correlation technique is impossible eliminate fully by multipath to disturb the C/A code tracking error of introducing; In addition, the receiver signal passage is under the condition of infinite bandwidth, reduce related interval d and can constantly reduce multipath error, and this condition obviously can't satisfy in actual applications.
Summary of the invention
The present invention is directed under the multipath signal disturbed condition, traditional code phase Discr. can not effectively suppress the interference of multipath, its phase demodulation error precision that improves algorithm is also not ideal enough, bad in actual applications realization has proposed a kind of based on the dark combined tracking loop of GPS/INS Gauss's code phase Discr. and method for designing thereof.
It is a kind of based on the dark combined tracking loop of GPS/INS Gauss code phase Discr. that the present invention proposes, the improvement that traditional receiver DLL loop has been carried out, on the basis of conventional code phase-shift discriminator, increased INS code phase Discr. module and Gauss's code phase Discr. module, the information source that specifically makes up Gauss's code phase Discr. of the present invention comprises local carrier generator, local C/A code generator, correlator, frequency mixer, integration totalizer, GPS receiver tracking loop circuit code phase Discr., Gaussian function generator and INS code phase Discr..The local carrier generator produces the carrier wave reproducing signals of 90 ° of phasic differences mutually on branch road in the same way and quadrature branch, local code C/A code generator is in that branch road and quadrature branch produce respectively in advance in the same way, instant and hysteresis replica code, intermediate-freuqncy signal respectively simultaneously by a frequency mixer and local carrier generator in the same way with the carrier wave reproducing signals multiplicative mixing of quadrature two branch roads generation, the mixing results that obtains again with local code C/A code generator branch road and quadrature branch in the same way produce respectively leading, immediately, the hysteresis replica code carries out the related operation of time, and the signal that obtains added up by an integration totalizer respectively, obtain the relevant output I of the leading branch road of in-phase branch
E, I
PAnd I
L, and the relevant output Q that reaches the hysteresis branch road in advance, immediately of quadrature branch
E, Q
PAnd Q
LThe relevant output I of the instant branch road of in-phase branch
PRelevant output Q with the instant branch road of quadrature branch
PIntroduce in the Gaussian function generator, the code phase information that the Gaussian function generator utilizes DLL to introduce is again according to relevant information μ
INS,
Make up synchronous advanced code phase function G
EWith hysteresis code phase function G
L, utilize advanced code phase function G
EWith hysteresis code phase function G
LMake up INS code phase Discr., upgrade, obtain the square error MSE of GPS receiver tracking loop circuit code phase Discr. by loop
GPSSquare error MSE with INS code phase Discr.
INS, two square errors are adjusted the output of GPS receiver tracking loop circuit code phase Discr. and INS code phase Discr. as weight coefficient, make up Gauss's code phase Discr. D
GAUSS
The above-mentioned a kind of method of design that the present invention proposes based on the dark combined tracking loop of GPS/INS Gauss code phase Discr., concrete steps are as follows:
Step 1: at first analyze the influence of multipath interference,, obtain the relevant output I of the leading branch road on the in-phase branch then according to code tracking loop principle of work to the code tracking loop
E, instant branch road relevant output I
P, the hysteresis branch road relevant output I
L, the relevant output Q of the leading branch road on the quadrature branch
E, instant branch road relevant output Q
PAnd the relevant output Q of hysteresis branch road
L
In the GPS navigation system, under the situation of not considering modulating data and noise, the signal model S (t) that receiver receives is
Wherein, A is the amplitude of direct signal; X (t) is a t C/A sign indicating number constantly, and ζ is the ratio of Doppler shift and carrier frequency, i.e. ζ=ω
d/ ω
c, ω
cBe carrier frequency, ω
dBe Doppler shift, τ
0The C/A sign indicating number time delay of expression direct signal, α
i=b
iA is the amplitude of i bar multipath signal, b
iIt is i bar multipath signal and the amplitude ratio of direct signal; θ
0And θ
iBe respectively the carrier phase deviation of direct signal and i bar multipath signal, M represents the bar number of multipath signal.
Step 2: choose GPS receiver tracking loop circuit code phase Discr. DGPS
The present invention adopts the incoherent after-power type code phase Discr. D that subtracts in advance
GPSAs treating improved initial code phase positions Discr., its expression formula is:
D
GPS=(I
E 2+Q
E 2)-(I
L 2+Q
L 2)
The relevant output I of the leading branch road on the in-phase branch that step 1 is obtained
E, the hysteresis branch road relevant output I
L, the relevant output Q of the leading branch road on the quadrature branch
E, the hysteresis branch road relevant output Q
LSubstitution initial code phase positions Discr. D
GPSIn, obtain the D under the multipath interference
GPSPhase demodulation function: D
GPS=D
n+ D
Err, wherein, D
nIncoherent phase demodulation output when not existing multipath to disturb, D
ErrDisturb the incoherent phase demodulation output that causes for multipath.
Obtain the D under the multipath interference
GPSBehind the phase demodulation function, it is carried out normalized.
Step 3: utilize the real-time code phase error of GPS receiver, make up INS advanced code phase function G
EWith hysteresis code phase function G
L
Measured Gaussian function:
Make up synchronous Gaussian function generator, the Gaussian function G (γ that this Gaussian function generator is adopted earlier in conjunction with the output information of INS with from GPS receiver DLL information again
GPS) as follows:
Wherein, γ
GPSFor deriving from the code phase error that receiver DLL produces in real time,
Be local code phase delay; τ
0The C/A sign indicating number time delay of expression direct signal, μ
INSBe the code phase error of INS system estimation,
Be the code phase square error of INS system estimation,, choose here for synchronous with gps system work
Consistent with the correlator interval d of DLL.
There is under the situation of i bar multipath signal interference the leading Gaussian function G that the Gaussian function generator produces
EWith hysteresis Gaussian function G
LBe respectively::
Wherein, Δ τ
iBe the C/A sign indicating number time delay of i bar multipath signal with respect to direct signal, Δ τ
i=τ
i-τ
0, τ
0C/A sign indicating number time delay for direct signal.If when having only a multipath signal, n gets 1,
τ
1C/A sign indicating number time delay for this multipath signal.If there are two multipath signals, n gets 2,
Δ τ
2=τ
2-τ
0, τ
2C/A sign indicating number time delay for the second multipath signal.In like manner, can calculate G under many multipath signals
EAnd G
L
Step 4: utilize advanced code phase function G
EWith hysteresis code phase function G
L, structure INS code phase Discr. D
INS:
D
INS=G
E 2-G
L 2
With the advanced code phase function G that obtains in the step 3
EWith hysteresis code phase function G
LSubstitution obtains the D under the multipath interference
INSThe phase demodulation function be:
Wherein, B=1/ (2 π d).
With the D under the multipath interference that obtains
INSThe phase demodulation function carry out normalized.
Step 5: determine GPS receiver tracking loop circuit code phase Discr. D
GPSSquare error MSE
GPSWith INS code phase Discr. D
INSSquare error MSE
INS, specifically:
Setting the loop update times is nf, and the renewal of loop each time for wherein all obtains corresponding relevant output I
E, Q
E, I
L, Q
L, and G
E, G
L, so code phase Discr. D
GPSWith INS code phase Discr. D
INSUpgrade nf time, determine their average then
Then can obtain MSE
GPSAnd MSE
INS, their expression formula is as follows:
Step 6: make up Gauss's code phase Discr. D
GAUSS:
D
GAUSS=(D
GPS/MSE
GPS)+(D
INS/MSE
INS)
Carry out after the normalization be:
The D that normalization obtains
GAUSSGauss's code phase Discr. that will make up exactly.
Advantage of the present invention and good effect are:
(1) the INS system introduces the instant branch road code phase information of GPS receiver DLL in the Gaussian function generator, make up INS code phase Discr., again with DLL in the code phase Discr. superpose by square error, be combined into Gauss's code phase Discr., changed the structure of traditional GPS receiver DLL, simulating, verifying under multipath signal disturbs, this Gauss's code phase Discr. can effectively improve the phase demodulation output characteristics really, reduce the code phase tracking error, also verified simultaneously the feasibility of design Gauss code phase Discr. method, provide some guided bone effects for further inquiring into the dark combined tracking loop design of GPS/INS.
(2) receiver is under multipath signal disturbs, set up the INS code phase Discr. of synchronous GPS operation of receiver according to inertial navigation information, come auxiliary receiver work then, the Gaussian function that utilizes the INS system to produce, improve C/A sign indicating number autocorrelation function peak-peak, and make the slope slope of both sides, autocorrelation function main peak top bigger, can effectively improve the precision of measuring the main peak apical position, improve the phase demodulation output characteristics of Discr. under multipath disturbs, reduce the code phase tracking error, thereby make under identical carrier-to-noise ratio condition, detection probability increases, help carrying out reacquisition after the signal losing lock, can effectively improve the efficient of signal reacquisition.
Description of drawings
Fig. 1 (a) is the structural drawing that makes up conventional code phase-shift discriminator information needed source;
Fig. 1 (b) is the structural drawing that makes up Gauss's code phase Discr. information needed of the present invention source;
Fig. 2 is leading, the hysteresis code phase analogous diagram that is used to make up INS code phase Discr.;
Fig. 3 (a) is the C/A sign indicating number autocorrelation function curve of independent GPS and C/A sign indicating number autocorrelation function curve that INS estimates;
C/A sign indicating number autocorrelation function curve after Fig. 3 (b) stack;
Fig. 4 (a) is under two multipath signals disturb, D
GPSEliminate the phase demodulation curve after multipath disturbs;
Fig. 4 (b) is under two multipath signals disturb, D
GAUSSEliminate the phase demodulation curve after multipath disturbs;
Fig. 5 (a) is along with loop upgrades, D
GPSAnd D
GAUSSThe code phase error analogous diagram of output;
Fig. 5 (b) is along with loop upgrades, D
GPSAnd D
GAUSSThe code phase error analogous diagram of output accumulation;
Fig. 6 is the process flow diagram that makes up Gauss's code phase Discr..
Embodiment
The present invention is further elaborated below in conjunction with accompanying drawing.
The conventional code phase-shift discriminator does not use the instant branch road code phase information in the DLL structure, and in the present invention, the instant branch road code phase information of DLL is as one of source that makes up INS code phase Discr. module information needed.The instant branch road code phase information of GPS receiver DLL is incorporated in the Gaussian function generator of INS system, in conjunction with the input of INS system, makes up INS code phase Discr..Continual renovation by loop, calculate the square error of conventional code phase-shift discriminator output data and the square error of INS code phase Discr. output data, with the weight coefficient of square error as measurement conventional code phase-shift discriminator and INS code phase Discr. precision, thereby be combined into Gauss's code phase Discr., it can increase the auto-correlation peak value of C/A sign indicating number, under multipath disturbs, improve the phase demodulation output performance, effectively reduce the code phase tracking error.
As Fig. 1 (a) is to make up the incoherent information source structural drawing (list of references 1: Yu Hailiang that subtracts after-power type code phase Discr. in advance of tradition, based on the auxiliary GPS receiver of INS and the research (D) of tracking technique, master thesis, Changsha: the National University of Defense technology, 2007,31-34), make up its needed information source and be mainly local carrier generator 1, frequency mixer 2, local C/A code generator 3, correlator 4, integration totalizer 5 and GPS receiver tracking loop circuit code phase Discr. 6.Fig. 1 (b) is improved on the basis of Fig. 1 (a), it is the structural drawing that Gauss's code phase Discr. of proposing of the present invention makes up, with respect to Fig. 1 (a), making up Gauss's code phase Discr. of the present invention has increased information source: Gaussian function generator 7 and INS code phase Discr. D
INS8, GPS receiver tracking loop circuit code phase Discr. D
GPS6 and INS code phase Discr. D
INS8 have further made up Gauss's code phase Discr. D of the present invention
GAUSS9.In Fig. 1 (b), local carrier generator 1 produces the carrier wave reproducing signals of 90 ° of phasic differences mutually on branch road in the same way and quadrature branch, local C/A code generator 3 produces respectively in advance in branch road and quadrature branch in the same way, immediately, the hysteresis replica code.Intermediate-freuqncy signal at first by frequency mixer 2 and local carrier generator 1 in the carrier wave reproducing signals multiplicative mixing that produces with quadrature two branch roads in the same way, realize that carrier wave peels off; Leading, instant, the hysteresis replica code carries out the some time respectively by a correlator 4 related operation that mixing results i, q produce in branch road and quadrature branch in the same way with local code C/A code generator 3 again generate i at branch road in the same way
E, i
PAnd i
LSignal generates q in quadrature branch
E, q
PAnd q
LSignal, at this moment, the C/A sign indicating number in the input signal is stripped from.In order further to improve signal to noise ratio (S/N ratio), the i that will obtain through correlator 4
E, i
P, i
L, q
E, q
PAnd q
LAfter signal carries out the integration accumulation by integration totalizer 5 respectively, become the relevant output I that reaches the hysteresis branch road in advance, immediately of in-phase branch respectively
E, I
PAnd I
L, and the relevant output Q that reaches the hysteresis branch road in advance, immediately of quadrature branch
E, Q
PAnd Q
LWherein, I
E, I
L, Q
EAnd Q
LBe used for making up traditional incoherent after-power type code phase Discr. that subtracts in advance, shown in Fig. 1 (a).Relevant output I
PAnd Q
PBe introduced in the Gaussian function generator 7, the code phase information that Gaussian function generator 7 utilizes DLL to introduce is again according to relevant information μ
INS,
Make up synchronous advanced code phase function G
EWith hysteresis code phase function G
L, so make up INS code phase Discr. 8 with them.Upgrade by loop, obtain GPS receiver tracking loop circuit code phase Discr. D respectively
GPS6 square error MSE
GPSWith INS code phase Discr. D
INS8 square error MSE
INS, two square errors are adjusted GPS receiver tracking loop circuit code phase Discr. D as weight coefficient
GPS6 and INS code phase Discr. D
INS8 output, thus make up high-precision Gauss's code phase Discr. D
GAUSS9.
What the present invention considered is the signal trace link, and temporary transient putative signal is successfully caught, and some major parameters of constructing Gauss's code phase Discr. of the present invention are as follows: the local code frequency f
LO=1.023MHz, the intermediate frequency carrier frequency f
IF=1575.42MHz, sample frequency f
s=5MHz, carrier loop bandwidth 16Hz, sign indicating number loop bandwidth 8Hz, damping factor ξ=0.707, sign indicating number loop gain K
Code=1, carrier wave ring gain K
Carr=0.5 π, loop update times nf=400, correlator spacing d=0.5 chip.The C/A code phase time delay of direct signal and multipath signal is 0 and 0.75 chip, and amplitude is respectively 1 and 0.65.
The present invention makes up the method for designing based on the dark combined tracking loop of GPS/INS Gauss code phase Discr. shown in Fig. 1 (b), and as shown in Figure 6, concrete steps are:
Step 1: at first analyze the influence of multipath interference, obtain the relevant output I of the leading branch road on the in-phase branch to the code tracking loop
E, instant branch road relevant output I
P, the hysteresis branch road relevant output I
L, the relevant output Q of the leading branch road on the quadrature branch
E, instant branch road relevant output Q
PAnd the relevant output Q of hysteresis branch road
L
In the GPS navigation system, under the situation of not considering modulating data and noise, the signal model S (t) that receiver receives is
Wherein, A is the amplitude of direct signal; X (t) is a t C/A sign indicating number constantly, and ζ is the ratio of Doppler shift and carrier frequency, i.e. ζ=ω
d/ ω
c, ω
cBe carrier frequency, ω
dBe Doppler shift, τ
0The C/A sign indicating number time delay of expression direct signal, α
i=b
iA is the amplitude of i bar multipath signal, b
iIt is i bar multipath signal and the amplitude ratio of direct signal; τ
iThe C/A sign indicating number time delay of representing i bar multipath signal, θ
0And θ
iBe respectively the carrier phase deviation of direct signal and i bar multipath signal, M represents the bar number of multipath signal.
Consider under the situation of a multipath signal, this moment M=i=1, the signal that receiver receives can get through down coversion and Phase Tracking:
S(t)=A·x[(1+ζ)t-τ
0]cos(ψ)+b
1A·x[(1+ζ)t-τ
0-Δτ
1]cos(ψ+β
1) (2)
Wherein, the carrier phase deviation of estimation
Be the carrier phase of local estimated signal, Δ τ
1=τ
1-τ
0Be the C/A sign indicating number time delay of a multipath signal with respect to direct signal, τ
1The C/A sign indicating number time delay of a multipath signal of expression, β
1=θ
1-θ
0Be the carrier phase deviation of multipath signal with respect to direct signal, θ
1The carrier phase deviation of a multipath signal of expression.
If local C/A sign indicating number sequence is
Be local code phase delay, carrier is ζ<<1 when non-high dynamic motion, temporarily ignores the influence of Doppler shift, and local C/A sign indicating number is
With the input signal S (t) carry out relevant:
In the following formula,
Be direct signal C/A code phase delay evaluated error, the autocorrelation function R (γ) of C/A sign indicating number sequence can be approximated to be:
In the following formula, T
cBe the time that chip continued of C/A sign indicating number.Be that direct signal or multipath signal all comprise carrier wave, C/A sign indicating number and three kinds of information of data, one of them C/A sign indicating number comprises 1023 chips, and time span is 1 millisecond, so T in direct signal and the multipath signal
CBeing the same, all is 1/1023 millisecond on the time.
By code tracking loop principle of work, getting the correlator spacing is d, the relevant output I of the leading branch road of in-phase branch
E, instant branch road relevant output I
PAnd the relevant output I of hysteresis branch road
LBe respectively:
In advance, immediately the relevant output that reaches the hysteresis branch road that in like manner can calculate quadrature branch is respectively Q
E, Q
P, Q
L:
Step 2: choose GPS receiver tracking loop circuit code phase Discr. D
GPS
The present invention adopts the incoherent after-power type code phase Discr. D that subtracts in advance
GPSAs treating improved initial code phase positions Discr., its expression formula is:
D
GPS=(I
E 2+Q
E 2)-(I
L 2+Q
L 2) (11)
After the relevant output substitution formula (11) that step 1 is obtained, obtain the D of multipath under disturbing
GPSThe phase demodulation function, employing formula (12) is carried out normalized:
Because its this code phase Discr. has utilized in the same way and quadrature branch simultaneously, performance is independent of the carrier phase locking ring, the dynamic range that is suitable for is bigger, can handle the signal of lower signal to noise ratio (S/N ratio), and its calculated amount is less, the computing velocity influence of the auxiliary back of adding inertia information is little, and inertia information can help, and its auto-correlation amplitude curve and powertrace are approaching to be overlapped.Bring formula (5) (7) (8) and (10) into (11) and can get the D of multipath under disturbing
GPSThe phase demodulation function is:
In the formula (13),
D
Err=D
GPS-D
n, D
nIncoherent phase demodulation output when not existing multipath to disturb; D
ErrDisturb the incoherent phase demodulation output that causes for multipath.
Step 3: the code phase information that Gaussian function generator 7 utilizes DLL to introduce, again according to relevant information μ
INS,
Make up synchronous advanced code phase function G
EWith hysteresis code phase function G
L
Measured Gaussian function
Again in conjunction with the output information of INS with to make up synchronous Gaussian function earlier from GPS receiver DLL information as follows:
Wherein, γ
GPSDerive from the code phase error that receiver DLL produces in real time,
Be local code phase delay; τ
0The C/A sign indicating number time delay of expression direct signal, μ
INSBe the code phase error of INS system estimation,
Be the code phase square error of INS system estimation,, choose here for synchronous with gps system work
Consistent with the code phase device interval d of DLL.
In order to make the INS system estimation go out code phase error, similar with DLL code generator principle of work, under the situation that multipath signal disturbs, the Gaussian function generator also needs to produce leading Gaussian function G
E, hysteresis Gaussian function G
L:
In formula (16) and (17), Δ τ
iBe i bar multipath signal with respect to the C/A sign indicating number time delay of direct signal if.If when having only a multipath signal, the n in formula (16) and (17) gets 1,
τ
1Be the C/A sign indicating number time delay of this multipath signal, τ
0C/A sign indicating number time delay for direct signal.If there are two multipath signals, n gets 2,
Δ τ
2=τ
2-τ
0, τ
2C/A sign indicating number time delay for the second multipath signal.In like manner, can calculate G under many multipath signals
EAnd G
L
Step 4: utilize advanced code phase function G
EWith hysteresis code phase function G
L, structure INS code phase Discr. D
INS
INS utilizes GPS receiver DLL information to set up out the code phase Discr. D of INS system
INS, its expression formula is:
D
INS=G
E 2-G
L 2 (18)
The advanced code phase function G that step 3 is obtained
EWith hysteresis code phase function G
LBring formula (18) into, obtain the D under the multipath interference
INSThe phase demodulation function, the D under the multipath that obtains disturbed
INSThe phase demodulation function adopt formula (19) to carry out normalized:
D
INS=(G
E 2-G
L 2)/(G
E 2+G
L 2) (19)
Bring formula (16) (17) into formula (18), obtain multipath and disturb D down
INSThe phase demodulation function be:
Wherein, B=1/ (2 π d).
Step 5: ask for D respectively
GPSSquare error MSE
GPSAnd D
INSSquare error MSE
INS
Need solve D
GPSMSE
GPSAnd D
INSSquare error MSE
INS, just can set up Gauss's code phase Discr..MSE
GPSAnd MSE
INSSolution procedure similar, by setup parameter, the loop update times is nf=400, upgrades for loop each time, the DLL of GPS receiver has the I of corresponding real-time change
E, Q
E, I
L, Q
L, and also all there is the G of pair change in the INS system
E, G
LSo, code phase Discr. D
GPSD with new structure
INSAlso to upgrade 400 times, can obtain their average like this
Then can obtain MSE
GPSAnd MSE
INS, their expression formula is as follows,
Step 6: make up Gauss's code phase Discr. D
GAUSS
Because square error is to consider the index of unbiasedness and validity simultaneously, so the dark combined tracking loop of the GPS/INS D of the present invention's proposition
GAUSSAdopt D
GPSSquare error MSE
GPSAnd D
INSSquare error MSE
INS, as the weight coefficient of systematic error estimation.D
GAUSSExpression formula be:
D
GAUSS=(D
GPS/MSE
GPS)+(D
INS/MSE
INS) (23)
After the normalization be:
As shown in Figure 2, be advanced code phase function G
EWith hysteresis code phase function G
LPhase place output in different loop updated time.The Gaussian function generator synchronously utilizes code phase in the GPS receiver and the information of INS, on the Gaussian function basis of standard, produces the leading function G of INS
E=G (γ
GPS-d) and hysteresis function G
L=G (γ
GPS+ d), and construct INS code phase Discr. D with similar GPS receiver code phase-shift discriminator aufbauprinciple
INS=(G
E 2-G
L 2)/(G
E 2+ G
L 2).
What provide above is the situation of a multipath signal, for many multipath signals, i.e. and M>1 o'clock, the following footnote i value in the formula (1) is from 1 to M, the situation of a computation process and a multipath signal is similar.As when having two multipath signals, this moment M=2, the i value be from 1 to 2, the signal that receiver receives passes through down coversion and Phase Tracking can get:
S(t)=A·x[(1+ζ)t-τ
0]cos(ψ)+b
1A·x[(1+ζ)t-τ
0-Δτ
1]cos(ψ+β
1)
+b
2A·x[(1+ζ)t-τ
0-Δτ
2]cos(ψ+β
2) (25)
Wherein, Δ τ
1=τ
1-τ
0With Δ τ
2=τ
2-τ
0Be respectively the 1st and the 2nd multipath signal C/A sign indicating number time delay, τ with respect to direct signal
1And τ
2The C/A sign indicating number time delay of representing the 1st and the 2nd multipath signal respectively, β
1=θ
1-θ
0And β
2=θ
2-θ
0Be respectively the 1st and the 2nd multipath signal carrier phase deviation, θ with respect to direct signal
1And θ
2The carrier phase deviation of representing the 1st and the 2nd multipath signal respectively.
Core of the present invention is to utilize the GPS relevant information to set up the INS code phase Discr. of synchronous working, and obtains the square error of conventional code phase-shift discriminator output data and the square error of INS code phase Discr. output data in real time.This invention has changed traditional receiver DLL inner structure, by simulating, verifying should the invention feasibility, shown in Fig. 3~Fig. 5 (b).
From Fig. 3 (a) as can be seen, the C/A sign indicating number autocorrelation function peak of curve of GPS is 1 separately, and the C/A sign indicating number autocorrelation function peak of curve that INS estimates is approximately 0.6.Gauss's code phase Discr. can be found out the autocorrelation function peak of curve about 1.6 that obtains with their auto-correlation function value stack from Fig. 3 (b).By changing the autocorrelation function curve, improve the discriminating precision of code phase error, can effectively suppress multipath and disturb.
Comparison diagram 4 (a) and Fig. 4 (b) do not exist under the multipath undesired signal as can be seen, and the phase demodulation when C/A code phase time delay is 0 is output as 0, and exists under the situation of multipath undesired signal, and skew has taken place the zero point of phase demodulation output.Contrast D
GPSAnd D
GAUSSPhase demodulation output under multipath disturbs can be observed the designed D of the present invention
GAUSSCan better suppress the interference of multipath signal, simulation result has verified that the present invention can fundamentally eliminate the error of being brought by the multipath interference.
Can clearly find out traditional incoherent after-power type code phase Discr. D that subtracts in advance by Fig. 5 (a)
GPSWith the code phase error output of Gauss's code phase Discr. of the present invention in different loop updated time, contrast is found, Gauss's code phase Discr. D of the present invention
GAUSSCurve of output all be better than the incoherent after-power type code phase Discr. D that subtracts in advance in overshoot, time to peak and rise time
GPSOutput, the former code phase error precision is also better, simulating, verifying Gauss's code phase Discr. that the present invention set up be feasible.
Fig. 5 (b) is D
GPSAnd D
GAUSSThe code phase error cumulative curve changes corresponding to the code phase error value among Fig. 5 (a), upgrades in preceding 50 times D at loop
GAUSSAnd D
GPSError amount be negative value, so accumulated error constantly increases D
GAUSSMaximum accumulated error compares D
GPSLittle about two chips.
Claims (9)
1. one kind based on the dark combined tracking loop of GPS/INS Gauss code phase Discr., the information source that makes up this Gauss's code phase Discr. comprises local carrier generator, local C/A code generator, correlator, frequency mixer, integration totalizer and GPS receiver tracking loop circuit code phase Discr., it is characterized in that information source also comprises Gaussian function generator and INS code phase Discr.; The local carrier generator produces the carrier wave reproducing signals of 90 ° of phasic differences mutually on branch road in the same way and quadrature branch, local code C/A code generator is in that branch road and quadrature branch produce respectively in advance in the same way, instant and hysteresis replica code, intermediate-freuqncy signal respectively simultaneously by a frequency mixer and local carrier generator in the same way with the carrier wave reproducing signals multiplicative mixing of quadrature two branch roads generation, the mixing results that obtains again with local code C/A code generator branch road and quadrature branch in the same way produce respectively leading, immediately, the hysteresis replica code carries out the related operation of time, and the signal that obtains added up by an integration totalizer respectively, obtain the relevant output I of the leading branch road on the in-phase branch
E, instant branch road relevant output I
P, the hysteresis branch road relevant output I
L, and the relevant output Q that reaches the hysteresis branch road in advance, immediately of quadrature branch
E, Q
PAnd Q
LThe relevant output I of the instant branch road of in-phase branch
PRelevant output Q with the instant branch road of quadrature branch
PIntroduce in the Gaussian function generator, the code phase information that the Gaussian function generator utilizes DLL to introduce is again according to relevant information μ
INS,
Make up synchronous advanced code phase function G
EWith hysteresis code phase function G
L, μ
INSBe the code phase error of INS system estimation,
Be the code phase square error of INS system estimation, utilize advanced code phase function G
EWith hysteresis code phase function G
LMake up INS code phase Discr., upgrade, obtain the square error MSE of GPS receiver tracking loop circuit code phase Discr. by loop
GPSSquare error MSE with INS code phase Discr.
INS, two square errors are adjusted the output of GPS receiver tracking loop circuit code phase Discr. and INS code phase Discr. as weight coefficient, make up Gauss's code phase Discr. D
GAUSS
2. according to claim 1 a kind of based on the dark combined tracking loop of GPS/INS Gauss code phase Discr., it is characterized in that the structure parameter of described Gauss's code phase Discr. is: the local code frequency f
LO=1.023MHz, the intermediate frequency carrier frequency f
IF=1575.42MHz, sample frequency f
s=5MHz, carrier loop bandwidth 16Hz, sign indicating number loop bandwidth 8Hz, damping factor ξ=0.707, sign indicating number loop gain K
Code=1, carrier wave ring gain K
Carr=0.5 π, loop update times nf=400, correlator spacing d=0.5 chip, the C/A code phase time delay of direct signal and multipath signal is 0 and 0.75 chip, amplitude is respectively 1 and 0.65.
3. one kind is designed the described method based on the dark combined tracking loop of GPS/INS Gauss code phase Discr. of claim 1, it is characterized in that, specifically comprises the steps:
Step 1: at first analyze the influence of multipath interference to the code tracking loop: in the GPS navigation system, under the situation of not considering modulating data and noise, the signal model S (t) that receiver receives is:
Wherein, A is the amplitude of direct signal, and x (t) is a t C/A sign indicating number constantly, and ζ is Doppler shift ω
dWith carrier frequency ω
cRatio, τ
0The C/A sign indicating number time delay of expression direct signal, α
i=b
iA is the amplitude of i bar multipath signal, b
iBe i bar multipath signal and the amplitude ratio of direct signal, τ
iThe C/A sign indicating number time delay of representing i bar multipath signal, θ
0And θ
iBe respectively the carrier phase deviation of direct signal and i bar multipath signal, M represents the bar number of multipath signal; By code tracking loop principle of work, obtain the relevant output I of the leading branch road on the in-phase branch then
E, instant branch road relevant output I
P, the hysteresis branch road relevant output I
L, the relevant output Q of the leading branch road on the quadrature branch
E, instant branch road relevant output Q
PAnd the relevant output Q of hysteresis branch road
L
Step 2: adopt the incoherent after-power type code phase Discr. that subtracts in advance, as the initial code phase positions Discr. for the treatment of improved GPS receiver tracking loop circuit, this initial code phase positions Discr. D
GPSFor:
The relevant output I of the leading branch road on the in-phase branch that step 1 is obtained
E, the hysteresis branch road relevant output I
LRelevant output Q with leading branch road on the quadrature branch
E, the hysteresis branch road relevant output Q
LSubstitution formula (2) obtains the D under the multipath interference
GPSPhase demodulation function: D
GPS=D
n+ D
Err, wherein, D
nIncoherent phase demodulation output when not existing multipath to disturb, D
ErrDisturb the incoherent phase demodulation output that causes for multipath;
With the D under the multipath interference that obtains
GPSThe phase demodulation function carries out normalized;
Step 3: make up the Gaussian function generator, and obtain INS advanced code phase function G
EWith hysteresis code phase function G
L, detailed process is:
At first, measured Gaussian function
Again in conjunction with the output information of INS with from the synchronous Gaussian function generator of GPS receiver DLL information architecture, the Gaussian function G (γ that the Gaussian function generator is adopted
GPS) as follows:
Wherein, γ
GPSFor deriving from the code phase error that receiver DLL produces in real time,
Be local code phase delay, μ
INSBe the code phase error of INS system estimation,
Be the code phase square error of INS system estimation,, choose for synchronous with gps system work
Consistent with the correlator interval d of DLL;
There is under the situation of i bar multipath signal interference the leading Gaussian function G that the Gaussian function generator produces
EWith hysteresis Gaussian function G
LBe respectively:
In formula (5)~(6), Δ τ
iBe the C/A sign indicating number time delay of i bar multipath signal with respect to direct signal, Δ τ
i=τ
i-τ
0, τ
0C/A sign indicating number time delay for direct signal;
Step 4: structure INS code phase Discr. D
INS:
The advanced code phase function G that then step 3 is obtained
EWith hysteresis code phase function G
LSubstitution formula (7) obtains the D under the multipath interference
INSThe phase demodulation function, and the D under the multipath that obtains disturbed
INSThe phase demodulation function carry out normalized;
Step 5: determine GPS receiver tracking loop circuit code phase Discr. D
GPSSquare error MSE
GPSWith INS code phase Discr. D
INSSquare error MSE
INS, specifically:
Wherein, nf is the loop update times, D
GPSThe value of the GPS receiver tracking loop circuit code phase Discr. when the i time loop upgraded during (i) expression was upgraded for nf time,
The average of representing the GPS receiver tracking loop circuit code phase Discr. that nf loop renewal obtains; D
INSThe value of the INS code phase Discr. when (i) showing the i time loop renewal,
The average of representing the INS code phase Discr. that nf loop renewal obtains;
Step 6: make up Gauss's code phase Discr. D
GAUSS:
Carry out after the normalization be:
Through type (11) obtains final Gauss's code phase Discr. D that will make up
GAUSS
4. a kind of method for designing according to claim 3 based on the dark combined tracking loop of GPS/INS Gauss code phase Discr., it is characterized in that, in the described step 1, under the situation of considering a multipath signal, the relevant output I of the leading branch road on the in-phase branch of acquisition
E, instant branch road relevant output I
P, the hysteresis branch road relevant output I
L, the relevant output Q of the leading branch road on the quadrature branch
E, instant branch road relevant output Q
PAnd the relevant output Q of hysteresis branch road
LBe respectively:
Wherein,
Be the carrier phase deviation of estimating,
Be direct signal C/A code phase delay evaluated error,
Be the carrier phase of local estimated signal, Δ τ
1=τ
1-τ
0Be the C/A sign indicating number time delay of a multipath signal with respect to direct signal, τ
1The C/A sign indicating number time delay of a multipath signal of expression, β
1=θ
1-θ
0Be the carrier phase deviation of multipath signal with respect to direct signal, θ
1The carrier phase deviation of a multipath signal of expression, d represents the correlator spacing, the autocorrelation function R (γ) of C/A sign indicating number sequence is approximately:
In the formula, T
cBe the time that chip continued of C/A sign indicating number.
5. according to claim 3 or 4 described a kind of methods for designing based on the dark combined tracking loop of GPS/INS Gauss code phase Discr., it is characterized in that, described correlator spacing d=0.5 chip, the C/A code phase time delay of direct signal and multipath signal is 0 and 0.75 chip, and amplitude is respectively 1 and 0.65.
6. a kind of method for designing based on the dark combined tracking loop of GPS/INS Gauss code phase Discr. according to claim 3 is characterized in that the D described in the step 2
GPSThe phase demodulation function, under the situation that has a multipath signal, its expression formula is:
7. a kind of method for designing based on the dark combined tracking loop of GPS/INS Gauss code phase Discr. according to claim 3 is characterized in that, the leading Gaussian function G that the Gaussian function generator in the described step 3 produces
EWith hysteresis Gaussian function G
L, be under one the situation, to be specially at multipath signal:
8. a kind of method for designing based on the dark combined tracking loop of GPS/INS Gauss code phase Discr. according to claim 3 is characterized in that the loop update times nf=400 described in the step 3.
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN 201210051003 CN102590835B (en) | 2012-03-01 | 2012-03-01 | GPS/INS tightly integrated tracking loop Gauss code phase discriminator and design method thereof |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN 201210051003 CN102590835B (en) | 2012-03-01 | 2012-03-01 | GPS/INS tightly integrated tracking loop Gauss code phase discriminator and design method thereof |
Publications (2)
Publication Number | Publication Date |
---|---|
CN102590835A CN102590835A (en) | 2012-07-18 |
CN102590835B true CN102590835B (en) | 2013-07-31 |
Family
ID=46479745
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN 201210051003 Expired - Fee Related CN102590835B (en) | 2012-03-01 | 2012-03-01 | GPS/INS tightly integrated tracking loop Gauss code phase discriminator and design method thereof |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN102590835B (en) |
Families Citing this family (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN104833987B (en) * | 2015-05-19 | 2016-03-16 | 武汉大学 | The appraisal procedure of supplementary delayed impact during GNSS/INS combines deeply |
EP3112905B1 (en) * | 2015-07-03 | 2018-02-21 | Centre National d'Etudes Spatiales | Gnss receiver calculating a non-ambiguous discriminator to resolve subcarrier tracking ambiguities |
CN105572701B (en) * | 2015-12-17 | 2017-11-24 | 深圳市力合微电子股份有限公司 | A kind of code ring phase detecting method for the tracking of Beidou II receiver weak signal |
CN106019326A (en) * | 2016-04-28 | 2016-10-12 | 中国船舶重工集团公司第七0七研究所 | Inertial navigation speed auxiliary receiver tracking loop algorithm |
CN105954775A (en) * | 2016-04-28 | 2016-09-21 | 中国船舶重工集团公司第七0七研究所 | Inertial acceleration assisted receiver tracking loop algorithm |
CN106125117B (en) * | 2016-06-22 | 2018-12-18 | 南京航空航天大学 | A kind of hypercompact combination local signal control amount generation method of inertia/satellite |
CN108828634A (en) * | 2018-04-26 | 2018-11-16 | 北京理工雷科雷达技术研究院有限公司 | A method of the tracking mistake of code ring caused by overcoming narrowband anti-interference |
CN108490416B (en) * | 2018-05-21 | 2019-04-02 | 北京理工大学 | A kind of high dynamic carrier phase tracking method of pseudo-code modulation continuous wave radar echo |
CN110045398B (en) * | 2019-04-30 | 2020-11-10 | 中国人民解放军国防科技大学 | Optimal correlation interval-based code phase zero crossing point deviation suppression method |
CN110554413B (en) * | 2019-09-03 | 2022-05-03 | 南京航空航天大学 | Continuous wave interference detection and identification method based on phase-amplitude locked loop |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN101765787B (en) * | 2007-05-29 | 2013-11-06 | 战神工程股份有限公司 | Highly integrated GPS, GALILEO and inertial navigation system |
-
2012
- 2012-03-01 CN CN 201210051003 patent/CN102590835B/en not_active Expired - Fee Related
Also Published As
Publication number | Publication date |
---|---|
CN102590835A (en) | 2012-07-18 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN102590835B (en) | GPS/INS tightly integrated tracking loop Gauss code phase discriminator and design method thereof | |
CN101132191B (en) | Baseband signal processing method for GNSS receiver | |
Martin et al. | BOC (x, y) signal acquisition techniques and performances | |
Zhao et al. | An open source GPS/GNSS vector tracking loop-implementation, filter tuning, and results | |
CN104375151B (en) | Navigation signal receiver and method of reseptance | |
CN101266292B (en) | GNSS reflected signal frequency domain processing unit and method | |
CN104536016B (en) | GNSS new-system signal capturing device and method | |
CN101839987B (en) | Implementation method for self-adaptive GPS software receiver | |
US9172524B2 (en) | Method of generating unambiguous correlation function for TMBOC (6,1,4/33)signal based on partial correlation functions, apparatus for tracking TMBOC signal, and satellite navigation signal receiver system using the same | |
CN104280746A (en) | Inertia-assisting GPS deep-integration semi-physical simulation system | |
CN102116866B (en) | Method and device for tracking global positioning system precision (GPS P) and/or Y code signal of full-cycle carrier | |
CN101359044B (en) | Method for calculating and eliminating interfere of GNSS strong signal to weak signal | |
CN105044737A (en) | Method for detecting observed quantity validity in navigation receiver | |
CN104316941A (en) | Vector tracking method based on carrier frequency assisted phase | |
CN101216549B (en) | Medium-high frequency wave spread-spectrum navigation system distance observed quantity extraction method | |
CN102253396A (en) | High dynamic global positioning system (GPS) carrier loop tracking method | |
CN103869337A (en) | Signal tracking method of global navigation satellite system, signal tracking apparatus and satellite signal reciever having the same | |
CN101937089B (en) | Method and apparatus for weak data bit sync in a positioning system | |
CN105911575A (en) | Cascade type inertia/satellite deep integration navigation filter observation quantity extraction method | |
CN102565825B (en) | Received signal strength fiduciary level decision maker, method and code phase error calculation method | |
CN102176034B (en) | Satellite losing lock judging method of GPS (Global Positioning System) receiver | |
CN109471137A (en) | A kind of implementation method of adaptive vector tracking loop | |
CN104931980B (en) | Carrier phase measurement half cycle obscures release method | |
Dong et al. | Implementation and verification of a software-based IF GPS signal simulator | |
CN105954772A (en) | Steady unbiased navigation signal vector tracking method |
Legal Events
Date | Code | Title | Description |
---|---|---|---|
C06 | Publication | ||
PB01 | Publication | ||
C10 | Entry into substantive examination | ||
SE01 | Entry into force of request for substantive examination | ||
C14 | Grant of patent or utility model | ||
GR01 | Patent grant | ||
CF01 | Termination of patent right due to non-payment of annual fee |
Granted publication date: 20130731 Termination date: 20200301 |
|
CF01 | Termination of patent right due to non-payment of annual fee |