Claims
- 1. A method of extrapolating the value of a navigation parameter (e.g., φBk or γBk) from a global positioning satellite as measured by a base receiver, said navigation parameter being transmitted to a rover receiver over a communication link in a sequence of consecutively provided frames, each frame comprising the measured value of the navigation parameter made for a specific time moment tk as designated by a clock in the base receiver, the start of each frame occurring at a time interval Tk from the start of the previous frame, the navigation parameter being extrapolated according to an extrapolation form comprising a constant, plus one or more terms which are a function of time, and one or more corresponding scaling parameters for scaling the terms, the values of said constant and scaling parameters being generated by said method, said method comprising the steps of:
(a) transmitting in each frame a measured value of the navigation parameter, a representation of the specific time moment tk as designated by a clock in the base receiver at which the value was measured, and a weight factor Kk representative of the estimated quality of measured value of said frame; (b) measuring the signal-to-noise ratio of the communication link during the time each frame is received by the rover; (c) storing a plurality Mr of the most recent consecutive frames in a memory of the rover, and further storing for each stored frame an indication representative of the signal-to-noise ratio of the communication link during the receipt of the corresponding stored frame; (d) generating a quality indication associated with each stored frame of whether the measured value of a frame is satisfactory or unsatisfactory, said quality indication being generated as satisfactory unless one or more unsatisfactory conditions occurs, said quality indication being generated as unsatisfactory when the signal-to-noise ratio of the communication link falls below a first threshold value during the reception of the frame; (e) selecting, after each frame is received and stored, a subset of a number ns of the most recent frames from said set Mr of stored frames which have satisfactory quality indications; (f) computing the values of the constant and scaling parameters of the extrapolation form from at least one selected subset of ns frames by an application of a least squares method which accounts for the weighting factors; and (g) generating an extrapolated value of the navigation parameter frame from the extrapolation form for one or more time moments occurring after the time moment of the last received frame.
- 2. A method according to claim 1 wherein said step (d) comprises the step of generating said quality indication as unsatisfactory when the weight factor Kk of the frame falls below a second threshold value during the reception of the frame.
- 3. A method according to claim 1 wherein said step (a) comprises the step of encoding each transmitted frame with error detecting information;
wherein said step (c) comprises the step of decoding the frames to detect transmission errors; and wherein said step (d) comprises the step of generating the quality indication of a frame as being unsatisfactory if said decoding step detects an error in said frame.
- 4. A method according to claim 1 wherein said step (a) comprises the step of encoding each transmitted frame with error detecting and correcting information;
wherein said step (c) comprises the step of decoding the frames to correct transmission errors and to detect transmission errors which cannot be corrected; and wherein said step (d) comprises the step of generating the quality indication of a frame as being unsatisfactory if said decoding step detects an error in said frame which cannot be corrected.
- 5. A method according to claim 1 wherein said step (e) generates a first alarm signal (“NO BASE MEASUREMENTS”) when the number of stored frames having satisfactory indications is less than ns; and
wherein said step (f) is performed after each frame is received and after step (e) is performed unless said first alarm signal has been generated.
- 6. A method according to claim 1 wherein said navigation parameter comprises the total phase φBk of a satellite carrier phase measured in the base receiver.
- 7. A method according to claim 1 wherein said navigation parameter comprises the pseudo-range δBk of a satellite measured in the base receiver.
- 8. A method according to claim 1, wherein said extrapolation form comprises a polynomial of degree np in time t, and wherein ns>np.
- 9. A method according to claim 8 wherein np=2, wherein ns>3, wherein 3≦Mr≦5, and wherein said time interval Tk is between 0.5 seconds and 2 seconds.
- 10. A method of detecting and correcting cycle slips in the phase measurements of a plurality n of satellite carrier signals (m=1 . . . n) made by a first navigation receiver (B) and a second navigation receiver (R), each of the navigation receivers tracking each satellite carrier signal with a phase lock loop, each phase lock loop capable of locking onto the satellite carrier signal at a plurality of separate points of steady balance which are spaced apart from one another by an respective interval ‘am’ of phase, a cycle slip being an unplanned transition from one point of steady balance to another, said method including the steps of:
(a) generating, for a plurality of sequential and discrete moments i of time, a plurality n of phase signals φi,mB (m=1 . . . n) representative of the phases of the satellite carrier signals as received by the first navigation receiver; (b) generating, for each discrete time moment i, a plurality n of phase signals φi,mR (m=1 . . . n) representative of the phases of the satellite carrier signals as received by the second navigation receiver; (c) receiving, for each discrete time moment i, a plurality n of distances Di,mB (m=1 . . . n) between the satellites and the first receiver, a plurality n of distances Di,mR (m=1 . . . n) between the satellites and the second receiver; (d) generating, for each discrete time moment i, a plurality n of single-difference residual signals Δφi,m (m=1 . . . n) in the form of: Δφi,m=(φi,mB−φi,mR)−1/λm·[Di,mB−Di,mR], where λm is the wavelength of the corresponding satellite carrier signal; (e) generating, for each discrete time moment i, a first estimate Δ{circumflex over (φ)}i,S of a selected residual signal Δφi,S corresponding to a selected satellite carrier signal S (S being in the group of m=1 . . . n) as a function of the residual signals Δφi,m (m=1 . . . n); (f) generating, for each discrete time moment i, a first mismatch signal δφi,S as a difference between the selected residual signal Δφi,S and the estimate Δ{circumflex over (φ)}i,S for it: δφi,S=Δφi,S−Δ{circumflex over (φ)}i,S; and (g) generating, for each discrete time moment i, a first correction signal φi,SC in relation to the first mismatch signal δφi,S according to the form: φi,SC=aS·round(δφi,S/aS), where round(*) is the operation of rounding the quantity δφi,S/aS to the nearest integer.
- 11. A method according to claim 10 further comprising the step of:
(h) generating, for one or more of the discrete time moments i, a first corrected residual signal Δφi,SC as a difference of the first single-difference residual signal Δφi,S and the first correction signal φi,SC: Δφi,SC=Δφi,S−φi,SC.
- 12. A method according to claim 11 wherein a baseline vector (x,y,z) relates the position of one receiver to the position of the other receiver, wherein each receiver has a time clock for referencing its measurements and wherein any difference between the time clocks may be represented by an offset q, and wherein said step (e) of generating the first estimate Δ{circumflex over (φ)}i,S of the selected residual signal Δφi,S comprises the steps of:
(i) generating, for each discrete time moment i, an additional estimate Δ{circumflex over (φ)}i,m for each of the other residual signals Δφi,m (m≠S); (j) generating, for each discrete time moment i, an additional mismatch signal δφi,m for each of the other residual signals Δφi,m(m≠S), the additional mismatch signal δφi,m being generated as a difference between each additional residual signal Δφi,m and its corresponding estimate Δ{circumflex over (φ)}i,m: δφi,m=Δφi,m−Δ{circumflex over (φ)}i,m(m≠S); (k) generating, for each discrete time moment i, an additional correction signal φi,mC (m≠S) for each of the other residual signals Δφi,m (m≠S) in the form: φi,mC=am·round(δφi,m/am)(m≠S), where round(*) is the operation of rounding the quantity δφi,m/am to the nearest integer: (l) generating, for each discrete time moment i, a corrected mismatch signal ψi,m (m≠S) for each of the other residual signals Δφi,m (m≠S) as a difference of the corresponding additional mismatch δφi,m (m≠S) and the corresponding additional correction φi,mC (m≠S): ψi,m=δφi,m−φi,mC(m≠S); (m) generating, for each discrete time moment i, a plurality of bias signals (Axφ, Ayφ, Azφ) representing biases in the coordinates of the base line vector (x, y, z) and a bias signal (Aqφ) representing a bias in the time clock offset q, said bias signals being generated in relation to the corrected mismatch signals ψi,m (m≠S); (n) generating, for each discrete time moment i, a plurality of respective estimate signals (Vx, Vy, Vz, Vq) for the bias signals (Axφ, Ayφ, Azφ, Aqφ) by filtering each bias signal; (o) generating, for each discrete time moment i, a plurality of projected estimates Vp,i,m (m=1 . . . n) by multiplying a geometric Jacobian matrix Hiφ with a vector Vdi of the estimate signals (Vx, Vy, Vz, Vq), three columns of matrix Hiφ comprising the directional cosines between one of the receivers and the satellites and a fourth column of matrix Hiφ comprising the unit vector, one of the projected estimates Vp,i,S corresponding to the selected residual signal Δφi,S and each of the remaining projected estimates Vp,i,m (m≠S) corresponding a respective one of the other residual signals Δφi,m (m≠S); and (p) integrating the projected estimate Vp,i,S corresponding to the selected residual signal Δφi,S with respect to time to generate the first estimate Δ{circumflex over (φ)}i,S; and wherein said step (i) of generating the additional estimates Δ{circumflex over (φ)}i,m comprises the step of integrating the remaining projected estimates with respect to time Vp,i,m (m≠S).
- 13. A method according to claim 12 wherein the corrected mismatch signals ψi,m (m≠S) may be grouped as a vector ψi of mismatch signals;
wherein said step (m) of generating the plurality of bias signals (Axφ, Ayφ, Azφ, Aqφ) comprises the step of multiplying a geometric pseudo-inverse matrix Giφ of matrix Hiφ with the vector ψi of mismatch signals, the resulting product of which comprises the plurality of bias signals (Axφ, Ayφ, Azφ, Aqφ).
- 14. A method according to claim 13 wherein Giφ is generated in the form:
- 15. A method according to claim 13 further comprising the step of:
(q) generating, for each discrete time moment i, a corrected mismatch signal ψi,S for the selected residual signal Δφi,S as a difference of the first mismatch signal δφi,S and the first correction signal φi,SC: ψi,S=δφi,S−φi,SC; and (r) adding the corrected mismatch signal ψi,S as a component to the vector ψi of mismatch signals.
- 16. A method according to claim 12 wherein the phase lock loops comprise a common circuit topology such that the intervals am (m=1 . . . n) are the same for all of the satellite carrier signals.
- 17. A method according to claim 11 wherein step (a) comprises the step of generating the phase signals φi,mB (m=1 . . . n) which are measured at the first navigation receiver by extrapolation at the second navigation receiver from measured values which are transmitted from the first navigation receiver to the second navigation receiver through a communication link.
- 18. A method according to claim 15 wherein the plurality of discrete time moments i are spaced from one another by a time interval TI which is in the range of 5 ms to 10 ms: wherein the phase lock loops comprise a common circuit topology such that am=0.5 cycles (m=1 . . . n);
wherein said steps (a)-(r) are performed for each discrete time moment i before being performed for the next time moment i+1; wherein the processing steps included by steps (e)-(g), (i)-(r) form a common tracking system which conveys each bias signal (Axφ, Ayφ, Azφ, Aqφ) through a feedback loop formed by the processing steps included by steps (e)-(g), (i)-(r), wherein the frequency response of each feedback loop has a bandwidth of between 15 Hz and 25 Hz; and wherein said step (n) of filtering each bias signal comprises the step of filtering each bias signal with a filter having a frequency transfer function of the form: 20Kd(p)=K1+K2p+K3p2,where p is the Laplacian operator.
- 19. A method according to claim 1 wherein said steps (a)-(h) are performed while the plurality of discrete time moments are occurring.
- 20. A method according to claim 1 wherein each of the first and second navigation receivers are stationary, wherein the plurality of discrete time moments occur over a first period of time, wherein steps (a) and (b) are performed while the plurality of discrete time moments are occurring, wherein steps (a) and (b) further comprise respective steps for recording the phase signals φi,mB (m=1 . . . n) and φi,mR (m=1 . . . n), and wherein said steps (c)-(h) are preformed during a second period time which follows said first period of time.
- 21. A method according to claim 15 wherein each of the first and second navigation receivers is stationary, wherein the plurality of discrete time moments occur over a first period of time, wherein steps (a) and (b) are performed while the plurality of discrete time moments are occurring, wherein steps (a) and (b) further comprise respective steps for recording the phase signals φi,mB (m=1 . . . n) and φi,mR (m=1 . . . n), and wherein said steps (c)-(r) are preformed during a second period time which follows said first period of time.
- 22. A method according to claim 21 wherein the plurality of discrete time moments i are spaced from one another by a time interval TI which is in the range of 0.05 seconds to 1 second;
wherein the phase lock loops comprise a common circuit topology such that am=0.5 cycles (m=1 . . . n); wherein said steps (a)-(r) are performed for each discrete time moment i before being performed for the next time moment i+1; wherein the processing steps included by steps (e)-(g), (i)-(r) form a common tracking system which conveys each bias signal (Axφ, Ayφ, Azφ, Aqφ) through a feedback loop formed by the processing steps included by steps (e)-(g), (i)-(r), wherein the frequency response of each feedback loop has a bandwidth of between 4 Hz and 0.2 Hz; and wherein said step (n) of filtering each bias signal comprises the step of filtering each bias signal with a filter having a frequency transfer function of the form: 21Kd(p)=K1′+K2′p,where p is the Laplacian operator.
- 23. A method according to claim 15 further comprising the step of:
(s) generating a first drift correction signal VIn,i,S as a function of the corrected mismatch signal ψi,S for the selected residual signal Δφi,S, the first drift correction signal VIni,S for correcting the first estimate Δ{circumflex over (φ)}i,S for systematic errors appearing in the selected residual signal Δφi,S; and wherein said step (p) comprises the step of adding the first drift correction signal VIn,i,S to the projected estimate Vp,i,S corresponding to the first residual signal Δφi,S to form a combined signal, and wherein said step (p) integrates the combined signal.
- 24. A method according to claim 23 wherein the step of generating a first drift correction signal VIn,i,S comprises the step of periodically sampling the corrected mismatch signal ψi,S for the selected residual signal Δφi,S at a plurality of time moments spaced apart by a time interval ΔTIn, and generating the first drift correction signal VIn,i,S in proportion to the sampled corrected mismatch signal ψi,S.
- 25. A method according to claim 24 wherein the time interval ΔTin is initially set to a value in the range of 0.01 seconds to 5.0 seconds;
wherein the first corrected residual signal Δφi,SC is provided to an ambiguity resolution process which generates an indication when the cycle ambiguity in the carrier phase has been resolved; and wherein the time interval ΔTin, is set to a value in the range of 60-200 seconds when an indication is generated that the cycle ambiguity has been resolved.
- 26. A method according to claim 24 wherein the time interval ΔTin is initially set to a value in the range of 0.01 seconds to 5.0 seconds for an initial period of time, and is thereafter set to a value in the range of 60-200 seconds.
- 27. A method according to claim 23 wherein the step of generating a first drift correction signal VIn,i,S comprises the step of integrating the corrected mismatch signal ψi,S for the selected residual signal Δφi,S with an integrating-type filter having a transfer function of the form (1+K4/p) or of the form (1+K4′/p+K5′/p2), wherein the corrected mismatch signal ψi,S is applied to the input of the integrating-type filter for an initial time period TW and thereafter removed, and wherein the first drift correction signal VIn,i,S is provided at the output of the integrating-type filter.
- 28. A method according to claim 27 wherein the first corrected residual signal Δφi,SC is provided to an ambiguity resolution process which generates an indication when the cycle ambiguity in the carrier phase has been resolved; and
wherein the corrected mismatch signal ψi,S for the selected residual signal Δφi,S is reapplied to the input of the integrating-type filter for another time period TW when an indication is generated that the cycle ambiguity has been resolved, and is thereafter removed.
- 29. A method according to claim 27 wherein the corrected mismatch signal ψi,S for the selected residual signal Δφi,S is reapplied to the input of the integrating-type filter for another time period TW, and thereafter removed.
- 30. A method according to claim 27 wherein said steps (a)-(s) are performed for each discrete time moment i before being performed for the next time moment i+1;
wherein the processing steps included by steps (e)-(g), (q), (s) and (p) form an individual feedback loop during the initial time period TW, the loop conveying the first drift correction signal VIn,i,S as a feedback signal through the processing steps included by steps (e)-(g), (q), (s) and (p); wherein the individual feedback loop has a second order of astaticism (type 2 servo system) during the initial time period TW; wherein the frequency response of the individual feedback loop has a bandwidth of between 1 Hz and 3 Hz; and wherein the initial time period TW is between 0.5 seconds and 3 seconds.
- 31. A method according to claim 27 wherein the corrected mismatch signal y f for the selected residual signal Δφi,S is reapplied to the input of the integrating-type filter for another time period TH, and wherein the time between the first and second applications of the corrected mismatch signal ψi,S is between 10 minutes and 15 minutes.
- 32. A method according to claim 15 further comprising the steps of:
monitoring the signal quality of the selected satellite carrier signal as received by the first navigation receiver (B) and generating a first alarm signal in an active state when the signal quality falls below a respective selected level; monitoring the signal quality of selected satellite carrier signal as received by the second navigation receiver (R) and generating a second alarm signal in an active state when the signal quality falls below a respective selected level; and generating a blocking signal in an active state whenever one or more of said first and second alarm signals are active, or whenever the absolute value of the corrected mismatch ψi,S for the selected residual signal Δφi,S is above a respective threshold Πδ; and wherein said step (r) comprises the step of removing the corrected mismatch signal ψi,S for the selected residual signal Δφi,S from the vector ψi of mismatch signals when the blocking signal is generated in an active state; and wherein said step (m) comprises the step of forming, when the blocking signal is generated in an active state, a reduced matrix Hiφ which has the matrix row corresponding to the first satellite signal removed and thereafter generating a replacement matrix Giφ from said reduced matrix Hiφ.
- 33. A method according to claim 32 wherein step (a) comprises the step of transmitting values for the phase signals φi,mB (m=1 . . . n) measured at the first navigation receiver to the second navigation receiver through a communication link; and
wherein the step of generating the blocking signal further comprises the steps of monitoring the signal quality of the communication link and generating the blocking signal in an active state when the quality of the communication link falls below a respective selected level.
- 34. A method according to claim 24 comprising the steps of:
monitoring the signal quality of the selected satellite carrier signal as received by the first navigation receiver (B) and generating a first alarm signal in an active state when the signal quality falls below a respective selected level; monitoring the signal quality of the selected satellite carrier signal as received by the second navigation receiver (R) and generating a second alarm signal in an active state when the signal quality falls below a respective selected level; generating a blocking signal in an active state whenever one or more of said first and second alarm signals are active, or whenever the absolute value of the corrected mismatch ψi,S corresponding to the selected satellite carrier signal is above a threshold Πδ; and blocking the sampling of the corrected mismatch signal ψi,S for the selected satellite carrier signal when the blocking signal is generated in an active state.
- 35. A method according to claim 34 wherein said step (r) further comprises the step of removing the corrected mismatch signal ψi,S for the selected residual signal Δφi,S from the vector ψi of mismatch signals when the blocking signal is generated in an active state; and
said step (m) further comprises the step of forming, when the blocking signal is generated in an active state, a reduced matrix Hiφ which has the matrix row corresponding to the first satellite signal removed and thereafter computing a replacement pseudo-inverse matrix Giφ from said reduced matrix Hiφ.
- 36. A method according to claim 32 comprising the step of:
generating the blocking signal in a non-active state when the absolute value of the corrected mismatch ψi,S for the selected residual signal Δφi,S remains below the threshold Πδ for a time period Td with said first and second alarm signals being non-active, said time period being greater than the time period TI between consecutive discrete time moments i.
- 37. A method according to claim 36 wherein the threshold Πδ=1.4 radians and the time period Td=1.0 second.
- 38. A method according to claim 34 comprising the step of:
generating the blocking signal in a non-active state when the absolute value of the corrected mismatch ψi,S for the selected residual signal Δφi,S remains below the threshold Πδ for a time period Td with said first and second alarm signals being non-active, said time period being greater than the time period TI between consecutive discrete time moments i.
- 39. A method according to claim 38 wherein the threshold Πδ=1.4 radians and the time period Td=1.0 second.
- 40. A method according to claim 11 further comprising the step of generating an error alarm signal (“OBSERVATION MISSING”) indicating that the first corrected residual signal Δφi,SC may have errors due to a cycle slip, said step including the steps of generating the error alarm signal in an active state whenever the value of the first correction signal φCi,S changes between consecutive discrete moments of time i, and generating the error alarm signal in a non-active state when the value of the first correction signal φCi,S remains unchanged for a period T1 of time, said time period T1 being greater than the time period T1 between consecutive-discrete time moments i.
- 41. A method according to claim 40 further comprising the steps of:
monitoring the signal quality of the selected satellite carrier signal as received by the first navigation receiver (B) and generating a first alarm signal in an active state when the signal quality falls below a respective selected level; and monitoring the signal quality of first selected satellite carrier signal as received by the second navigation receiver (R) and generating a second alarm signal in an active state when the signal quality falls below a respective selected level; and wherein the step of generating the error alarm signal further includes the step of generating the error alarm signal in an active state whenever any of the first and second alarm signals are in their active states.
- 42. A method according to claim 41 wherein the time period T1=1.0 second.
- 43. A method of floating ambiguity resolution for phase measurements of a plurality n of satellite carrier signals made by a first navigation receiver (B) and a second navigation receiver (R), each satellite carrier signal being transmitted by a satellite and having a wavelength, wherein a baseline vector (x,y,z) relates the position of one receiver to the other receiver, wherein each receiver has a time clock for referencing its measurements and wherein any difference between the time clocks may be represented by an offset q, said method receiving, for a plurality of sequential and discrete moments j, the following inputs:
a vector γjB of a plurality of pseudo-ranges measured by the first navigation receiver (B) and corresponding to the plurality of satellite carrier signals, a vector γjR of a plurality of pseudo-ranges measured by the second navigation receiver (R) and corresponding to the plurality of satellite carrier signals, a vector DjB of a plurality of estimated distances between the satellites and the first navigation receiver (B), a vector DjR of a plurality of estimated distances between the satellites and the second navigation receiver (R), a vector φjB of a plurality of full phase measurements of the satellite carrier signals measured by the first navigation receiver (B), a vector φjR of a plurality of full phase measurements of the satellite carrier signals measured by the second navigation receiver (R), a geometric Jacobian matrix Hjγ whose matrix elements are representative of the changes in the distances between the satellites and one of the receivers that would be caused by changes in that receiver's position and time clock offset, said method comprising the steps of: (a) generating, for each discrete time moment j, a vector Δγj of a plurality of range residuals of pseudo-range measurements made by the first and second navigation receivers in the form of: Δγj=(γjR−γjB)−(DjR−DjB); (b) generating, for each discrete time moment j, a vector Δφj of a plurality of phase residuals of full phase measurements made by the first and second navigation receivers in the form of: Δφj=(φjR−φjB)−Λ−1·(DjR−DjB), where Λ−1 is a diagonal matrix comprising the inverse wavelengths of the satellites, (c) for each discrete time moment j, representing the errors in the measured pseudo-ranges and distances with a vector [Δx, Δy, Δz, c·Δτ]T of corrections to the baseline vector and the clock offsets of the receivers, and representing the preliminary estimates of the floating ambiguities at each time moment j by a preliminary estimation vector Ñj; (d) solving, for each discrete time moment j, the following two sets of vector relationships jointly by a least squares method to generate the preliminary estimation vector vector Ñj: Δφj=Ñj+Λ−1·Hjγ·[Δx,Δy,Δz,c·Δτ]T and Δγj=Hjγ·[Δx,Δy,Δz,c·Δτ]T; (e) generating, for each discrete time moment j after the initial time moment, a main estimation vector {circumflex over (N)}−j as a weighed summation of the preliminary estimation vector Ñj and the main estimation vector {circumflex over (N)}j−1 generated at the previous time moment (j−1), the main estimation vector {circumflex over (N)}1 at the initial time moment j=1 being set to an initial vector of values.
- 44. A method according to claim 43 wherein step (d) comprises the steps of:
(f) grouping the vectors Δγj and Δφj into an observation vector μj=[Δγj, Δφj]T; (g) representing estimates for the corrections vector [Δx, Δy, Δz, c·Δτ]T and for the preliminary estimation vector Ñj by an estimated state vector Âj=[Δx, Δy, Δz, c·Δτ, Ñj]T, said estimated state vector Âj being an estimation of a true state vector Aj of the least squares method; (h) forming an observation matrix Hjμ from the geometric Jacobian matrix Hjγ, the matrix Λ−1 of inverse wavelengths, the zero matrix 0, and the identity matrix E, in a form comprising four sub-matrices arranged in two rows and two columns: 22Hjμ=[Hjγ0Λ-1·HjγE],wherein the two systems of equations are represented as μj=Hjμ·Aj in the least squares method; (i) generating a phase covariance matrix Rjφ representative of the accuracy of the measurements of the vector of phase residuals Δφj; (j) generating a pseudo-range covariance matrix Rjγ representative of the accuracy of the measurements of the vector of pseudo-range residuals Δγj; (k) generating an observation covariance matrix Rj from the phase covariance matrix Rjφ, the pseudo-range covariance matrix Rjγ, and the zero matrix 0 in a form comprising four sub-matrices arranged in two rows and two columns: 23Rj=[Rjγ00Rjφ];and (l) generating the values of the estimated state vector Âj according to the form: Âj=[(Hjμ)T·Rj−1·Hjμ]−1·(Hjμ)T·Rj−1·μj, to generate the values of the preliminary estimation vector Ñj.
- 45. A method according to claim 44 wherein the block matrix rows of the observation matrix Hjμ are exchanged, wherein the sub-vectors Δγj and Δφj of the observation vector μj are exchanged, and wherein the sub-matrices Rjφ and Rjγ of matrix Rj are exchanged.
- 46. A method according to claim 45 wherein the block columns of the observation matrix Hjμ are exchanged, and wherein the sub-vectors [Δx, Δy, Δz, c·Δτ]T and Ñj of the estimated state vector Âj are exchanged.
- 47. A method according to claim 44 wherein the block columns of the observation matrix Hjμ are exchanged, and wherein the sub-vectors [Δx, Δy, Δz, c·Δτ]T and Ñj of the estimated state vector Âj are exchanged.
- 48. A method according to claim 44 wherein said method receives, for a plurality of sequential and discrete time moments j, the following inputs:
a plurality of first weight coefficients Kj,lφB, . . . , Kj,mφB, . . . , Kj,nφB representative of the measurement accuracy of the measured phase components of the vector φjB measured by the first navigation receiver, a plurality of second weight coefficients Kj,lφR, . . . , Kj,mφR, . . . , Kj,nφR representative of the measurement accuracy of the measured phase components of the vector φjR measured by the second navigation receiver, a plurality of third weight coefficients Kj,lγB, . . . , Kj,mγB, . . . , Kj,nγB representative of the measurement accuracy of the measured pseudo-range components of the vector γjB measured by the first navigation receiver, and a plurality of fourth weight coefficients Kj,lγR, . . . , Kj,mγR, . . . , Kj,nγR representative of the measurement accuracy of the measured pseudo-range components of the vector γjR measured by the second navigation receiver; and wherein said step (i) of generating the phase covariance matrix Rjφ comprises the steps of generating a plurality of fifth weight coefficients Kj,lφ, . . . Kj,mφ, . . . Kj,nφ from the plurality of first and second weight coefficients, each fifth weight coefficient Kj,mφ (m=1 to m=n) being generated as a first small number when either of the magnitudes of the corresponding first and second weight coefficients Kj,mφB and Kj,mφR is less than a first threshold value, the magnitude of said first small number being less than the first threshold value, each fifth weight coefficient Kj,mφ (m=1 to m=n) being generated according to the relationship: (Kj,mφ)−1=(Kj,mφB)−1+(Kj,mφR)−1 when each of the magnitudes of the first and second weight coefficients Kj,mφB and Kj,mφR is greater than the first threshold value, and wherein the matrix Rjφ is generated in the form: 24Rjφ=[(Kj,1φ)-10⋯00(Kj,2φ)-1⋯0⋮⋮⋰⋮00⋯(Kj,nφ)-1];and wherein said step (j) of generating the pseudo-range covariance matrix Rjγ comprises the steps of generating a plurality of sixth weight coefficients Kj,lγ, . . . Kj,mγ, . . . Kj,nγ from the plurality of third and fourth weight coefficients, each sixth weight coefficient Kj,mγ (m=1 to m=n) being generated as a second small number when either of the magnitudes of the corresponding third and fourth weight coefficients Kj,mγB and Kj,mγR is less than a second threshold value, the magnitude of said second small number being less than the second threshold value, each sixth weight coefficient Kj,mγ (m=1 to m=n) being generated according to the relationship: (Kj,mγ)−1=(Kj,mγB)−1+(Kj,mγR)−1 when each of the magnitudes of the third and fourth weight coefficients Kj,mγB and Kj,mγR is greater than the second threshold value, and wherein the matrix Rjγ is generated in the form: 25Rjγ=[(Kj,1γ)-10⋯00(Kj,2γ)-1⋯0⋮⋮⋰⋮00⋯(Kj,nγ)-1].
- 49. A method according to claim 43 wherein said step (e) of generating the main estimation vector {circumflex over (N)}j comprises the steps of:
(f) generating, at each discrete time moment j, a first ambiguity covariance matrix {tilde over (R)}jN representative of the errors in the preliminary estimation vector Ñj; (g) generating, at each discrete time moment j, a second ambiguity covariance matrix RjN as an initial value for the initial time moment j=1, and in a form equivalent to: RjN=[({tilde over (R)}jN)−1+(Rj−1N)−1]−1 for each time moment j after the initial time moment j=1; (h) generating, at each discrete time moment j, a weighting matrix Wj in a form equivalent to Wj={tilde over (R)}jN·({tilde over (R)}jN+Rj−1N)−1; and (i) generating the main estimation vector {circumflex over (N)}j as a initial value for the initial time moment j=1, and in a form of: {circumflex over (N)}j=Wj·{circumflex over (N)}j−1+(E−Wj)·Ñj, for each discrete time moment j after the initial time moment j=1, wherein E is the identity matrix.
- 50. A method according to claim 49 wherein the second ambiguity covariance matrix RjN is set to an initial value of R1N=R1N for the initial time moment j=1;
- 51. A method according to claim 49 wherein the main estimation vector {circumflex over (N)}j is assigned a starting value for the initial time moment j=1 of {circumflex over (N)}j=Ñj.
- 52. A method according to claim 49 wherein the first ambiguity covariance matrix {tilde over (R)}jN for each discrete time moment j is generated by process which provides an equivalent result as the steps of:
(j) forming an observation matrix Hjμ from the geometric Jacobian matrix Hjγ, the matrix Λ−1 of inverse wavelengths, the zero matrix 0, and the identity matrix E in a form comprising four sub-matrices arranged in two rows and two columns: 26Hjμ=[Hjγ0Λ-1·HjγE];(k) generating a phase covariance matrix Rjφ representative of the measurement accuracy of the phase observation vector μjφ; (l) generating a pseudo-range covariance matrix Rjγ representative of the measurement accuracy of the pseudo-range observation vector μjγ; (m) generating an observation covariance matrix Rj from the phase covariance matrix Rjφ, the pseudo-range covariance matrix Rjγ, and the zero matrix 0, in a form comprising four sub-matrices arranged in two rows and two columns: 27Rj=[Rjγ00Rjφ];(n) generating a third ambiguity covariance matrix j the form: j=[(Hjμ)T·Rj−1·Hjμ]−; and (o) generating the first ambiguity covariance matrix {tilde over (R)}jN as the sub-matrix comprising the last n rows and last n columns of the third covariance matrix j.
- 53. A method according to claim 43 wherein said step (e) of generating the main estimation vector {circumflex over (N)}j comprises the step of generating the main estimation vector {circumflex over (N)}j in the form:
- 54. A method according to claim 53 wherein said method receives an input alarm signal for each satellite carrier signal indicating if any one of the measured phases or psuedo-ranges for the corresponding satellite carrier signal is erroneous, and wherein the components of vectors {circumflex over (N)}j , {circumflex over (N)}j−1 and Ñj corresponding to a satellite carrier signal are removed from the vectors if the alarm signal for the corresponding satellite carrier signal is received.
- 55. A method according to claim 43 wherein the discrete time moments j are separated from one another by a time interval TJ in the range of 0.1 seconds to 1 second.
- 56. A method according to claim 49 wherein the discrete time moments j are separated from one another by a time interval TJ in the range of 0.1 seconds to 1 second.
- 57. A method according to claim 53, wherein the discrete time moments j are separated from one another by a time interval TJ=1 second, and wherein said steps (a) through (e) are performed for a period of time TS which is in the range of 8 seconds to 10 seconds.
- 58. A method according to claim 43 wherein said step (e) of generating the main estimation vector {circumflex over (N)}j comprises the step of generating the main estimation vector {circumflex over (N)}j as an initial value for the initial time moment j=1 and in the form:
- 59. A method according to claim 58 wherein the main estimation vector {circumflex over (N)}j is assigned a starting value for the initial time moment j=1 of {circumflex over (N)}j=Ñj.
- 60. A method according to claim 58 wherein the first ambiguity covariance matrix {tilde over (R)}jN for each discrete time moment j is generated by process which provides an equivalent result as the steps of:
(m) forming an observation matrix Hjμ from the geometric Jacobian matrix Hjγ, the matrix Λ−1 of inverse wavelengths, the zero matrix 0, and the identity matrix E in a form comprising four sub-matrices arranged in two rows and two columns: 33Hjμ=[Hjγ0Λ-1·HjγE];(n) generating a phase covariance matrix Rjφ representative of the measurement accuracy of the phase observation vector μjφ; (o) generating a pseudo-range covariance matrix Rjγ representative of the measurement accuracy of the pseudo-range observation vector μjγ; (r) generating an observation covariance matrix Rj from the phase covariance matrix Rjφ, the pseudo-range covariance matrix Rjγ, and the zero matrix 0, in a form comprising four sub-matrices arranged in two rows and two columns: 34Rj=[Rjγ00Rjφ];(q) generating a fifth ambiguity covariance matrix j in the form: j=[(Hjμ)T·Rj−1·Hjμ]−1; and (r) generating the first ambiguity covariance matrix {tilde over (R)}jN as the sub-matrix comprising the last n rows and last n columns of the fifth covariance matrix j.
- 61. A method according to claim 58 wherein the second ambiguity covariance matrix j* is set to the value of {tilde over (R)}lN the initial time moment j=1.
- 62. A method according to claim 58 wherein the fourth ambiguity covariance matrix RjN is set to the value of RlN={haeck over (R)}lN for the first iteration.
- 63. A method according to claim 58 wherein the discrete time moments j in steps (a) through (g) are separated from one another by a time interval TJ which is between 0.1 seconds and 1 second; and
wherein the iterations k in steps (h) through (l) are separated from one another by a time interval Ts which is between 8 seconds and 10 seconds.
- 64. A method according to claim 48 wherein the measured phases of each component of the phase residual vector Δφj are monitored for the presence of cycle slips;
wherein said method receives an input alarm signal for each component of the phase residual vector Δφj indicating if a cycle slip has occurred in its measured phases; and wherein said step (i) further comprises the step of generating the fifth weight coefficient Kj,mφ for component of the phase residual vector Δφj as the first small number when the alarm signal for the component is received.
- 65. A method according to claim 44 further comprising the steps of:
generating, for each discrete time moment j, a set of baseline estimation corrections to the baseline coordinates as the corresponding components of the estimated state vector Âj; and correcting, for each discrete time moment j, the vector DjR of estimated distances between the satellites and the second navigation receiver (R) on the basis of the set of baseline estimation corrections generated at the previous time moment j−1.
- 66. A method according to claim 65 further comprising the step of:
correcting, for each discrete time moment j, the geometric Jacobian matrix Hjγ on the basis of the set of baseline estimation corrections generated at the previous time moment j−1.
- 67. A method according to claims 43 wherein the first and second receivers are stationary; and
wherein the same geometric Jacobian matrix Hjγ is used for a plurality of discrete time moments j.
- 68. A method according to claim 43 wherein step (d) comprises the steps of:
(f) grouping the vectors Δγj and Δφj into an observation vector μj=[Δγj, Δφj]T; (g) representing estimates for the corrections vector [Δx, Δy, Δz, c·Δτ]T and for the preliminary estimation vector Ñj by an estimated state vector Âj=[Δx, Δy, Δx, c·Δτ, Ñj]T, said estimated state vector Âj being an estimation of a true state vector Aj of the least squares method; (h) forming an observation matrix Hjμ from the geometric Jacobian matrix Hjγ, the matrix Λ−1 of inverse wavelengths, the zero matrix 0, and the identity matrix E, in a form comprising four sub-matrices arranged in two rows and two columns: 35Hjμ=[Hjγ0Λ-1·HjγE],wherein the two systems of equations are represented as μj=Hjμ·Aj in the least squares method; (i) generating a phase covariance matrix Rjφ representative of the accuracy of the measurements of the vector of phase residuals Δφj; (j) generating a pseudo-range covariance matrix Rjγ representative of the accuracy of the measurements of the vector of pseudo-range residuals Δγj; (k) generating an observation covariance matrix Rj from the phase covariance matrix Rjφ, the pseudo-range covariance matrix Rjγ, and the zero matrix 0 in a form comprising four sub-matrices arranged in two rows and two columns: 36Rj=[Rjγ00Rjφ];and (l) generating the values of the estimated state vector Âj according to the form: Âj=[(Hjμ)T·Rj−1·Hjμ]−·(Hjμ)T·Rj−1·μj, (m) generating a preliminary augmented estimation vector {tilde over (B)}j as the components of state vector Âj which comprise the corrections [Δx, Δy, Δz]T to the base line vector and the preliminary estimation vector Ñj of the floating ambiguities; (n) generating a main augmented estimation vector {circumflex over (B)}j as a weighed summation of the preliminary augmented estimation vector {tilde over (B)}j and the main augmented estimation vector {circumflex over (B)}j−1 generated at the previous time moment (j−1), the main augmented estimation vector {circumflex over (B)}1 at the initial time moment j=1 being set to an initial vector of values; (o) generating the main estimation vector {circumflex over (N)}j as the corresponding floating ambiguity components of the main augmented estimation vector {circumflex over (B)}j.
- 69. A method according to claim 68 wherein the block matrix rows of the observation matrix Hjμ are exchanged, wherein the sub-vectors Δγj and Δφj of the observation vector μj are exchanged, and wherein the sub-matrices Rjφ and Rjγ of matrix Rj are exchanged.
- 70. A method according to claim 69 wherein the block columns of the observation matrix Hjμ are exchanged and wherein the sub-vectors [Δx, Δy, Δz, c·Δτ]T and Ñj of the estimated state vector Âj are exchanged.
- 71. A method according to claim 68 wherein the block columns of the observation matrix Hjμ are exchanged, and wherein the sub-vectors [Δx, Δy, Δz, c·Δτ]T and Ñj of the estimated state vector Âj are exchanged.
- 72. A method according to claim 68 wherein said step (n) comprises the steps of:
(p) generating, at each discrete time moment j, a first augmented covariance matrix {tilde over (R)}jN representative of the errors in the preliminary augmented estimation vector {tilde over (B)}j; (q) generating, at each discrete time moment j, a second augmented covariance matrix RjN as an initial value for the initial time moment j=1, and in a form equivalent to: RjN=[({tilde over (R)}jN)−1+(Rj−1N)−1]−1 for each time moment j after the initial time moment j=1; (r) generating, at each discrete time moment j, a weighting matrix Wj in a form equivalent to Wj={tilde over (R)}jN·({tilde over (R)}jN+Rj−1N)−1; and (s) generating the main augmented estimation vector {circumflex over (B)}j as a starting value for the initial time moment j=1, and in a form equivalent to: {circumflex over (B)}j=Wj·{circumflex over (B)}j−1+(E−Wj)·{tilde over (B)}j, for each discrete time moment j after the initial time moment j=1, wherein E is the identity matrix.
- 73. A method according to claim 72 wherein the first ambiguity covariance matrix {tilde over (R)}jN for each discrete time moment j is generated by process which provides an equivalent result as the steps of:
(t) forming an observation matrix Hjμ from the geometric Jacobian matrix Hjγ, the matrix A of inverse wavelengths, the zero matrix 0, and the identity matrix E in a form comprising four sub-matrices arranged in two rows and two columns: 37Hjμ=[Hjγ0Λ-1·HjγE];(u) generating a phase covariance matrix Rjφ representative of the measurement accuracy of the phase observation vector ujφ; (v) generating a pseudo-range covariance matrix Rjγ representative of the measurement accuracy of the pseudo-range observation vector μjγ; (w) generating an observation covariance matrix Rj from the phase covariance matrix Rjφ, the pseudo-range covariance matrix Rjγ, and the zero matrix 0, in a form comprising four sub-matrices arranged in two rows and two columns: 38Rj=[Rjγ00Rjφ];(x) generating a third ambiguity covariance matrix j in the form: z,900j=[(Hjμ)T·Rj−1·Hjμ]−1; and (y) generating the first ambiguity covariance matrix {tilde over (R)}jN as the sub-matrix comprising the all of the rows and columns of the third covariance matrix j except for the row and column corresponding to the correction for the time offset (c·Δτ).
- 74. A method of floating ambiguity resolution for phase measurements of a plurality n of satellite carrier signals made by a first navigation receiver (B) and a second navigation receiver (R), each satellite carrier signal being transmitted by a satellite and having a wavelength, wherein a baseline vector (x,y,z) relates the position of one receiver to the other receiver, wherein each receiver has a time clock for referencing its measurements and wherein any difference between the time clocks may be represented by an offset q, said method receiving, for a plurality of sequential and discrete moments j, the following inputs:
a vector γjB of a plurality of pseudo-ranges measured by the first navigation receiver (B) and corresponding to the plurality of satellite carrier signals, a vector γjR of a plurality of pseudo-ranges measured by the second navigation receiver (R) and corresponding to the plurality of satellite carrier signals, a vector DjB of a plurality of estimated distances between the satellites and the first navigation receiver (B), a vector DjR of a plurality of estimated distances between the satellites and the second navigation receiver (R), a vector φjB of a plurality of full phase measurements of the satellite carrier signals measured by the first navigation receiver (B), a vector φjR of a plurality of full phase measurements of the satellite carrier signals measured by the second navigation receiver (R), a geometric Jacobian matrix Hjγ whose matrix elements are representative of the changes in the pseudoranges between the satellites and one of the receivers that would be caused by changes in that receiver's position and time clock offset, said method comprising the steps of: (a) generating, for each discrete time moment j, a pseudo-range observation vector μjγ comprising a plurality of range residuals of pseudo-range measurements made by the first and second navigation receivers in the form of: μjγ=(γjR−γjB)−(DjR−DjB); (b) generating, for each discrete time moment j, a phase observation vector μjφ comprising a plurality of phase residuals of full phase measurements made by the first and second navigation receivers in the form of: μjφ=(φjR−φjB)−Λ−1·(DjR−DjB); where Λ−1 is a diagonal matrix comprising the inverse wavelengths of the satellites: (c) representing, for each discrete time moment j, the errors in the measured pseudoranges and distances with a vector [Δx, Δy, Δz, c·Δτ]T of corrections to the baseline vector and the clock offsets of the receivers, and representing the preliminary estimates of the floating ambiguities at each time moment j by a preliminary estimation vector Ñj; (d) solving, for each discrete time moment j, the following vector relationship: μjγ=Hjγ·[Δx,Δy,Δz,c·Δτ]T by a least squares method to generate an estimate vector Ajγ for the corrections vector [Δx, Δy, Δz, c·Δτ]T; (e) generating, for each discrete time moment j, an estimated phase observation vector {circumflex over (μ)}jφ by multiplying the estimate vector Ajγ by matrices Hjγ and Λ−1 according to the form: {circumflex over (μ)}jφ=Λ−1·Hjγ·Ajγ; (f) generating, for each discrete time moment j, the preliminary estimation vector Ñj as the difference between the phase observation vector μjφ and the estimated phase observation vector {circumflex over (μ)}jφ according to the form: Ñj=μjφ−{circumflex over (μ)}jφ; (g) generating, for each discrete time moment j after the initial time moment, a main estimation vector {circumflex over (N)}j as a weighed summation of the preliminary estimation vector Ñj and the main estimation vector {circumflex over (N)}j−1 generated at the previous time moment (j−1), the main estimation vector {circumflex over (N)}1 at the initial time moment j=1 being set to an initial vector of values.
- 75. A method according to claim 74 wherein step (d) comprises the steps of:
(h) generating a pseudo-range covariance matrix Rjγ representative of the accuracy of the pseudo-range observation vector μjγ; and (i) generating the estimate vector Ajγ according to the form: Âjγ=[(Hjγ)T·(Rjγ)−1·Hjγ]−1·(Hjγ)T·(Rjγ)−1·μjγ.
- 76. A method according to claim 75 wherein said method receives, for a plurality of the discrete time moments j, the following inputs:
a plurality of first weight coefficients Kj,lγB, . . . , Kj,mγB, . . . , Kj,nγB representative of the measurement accuracy of the measured pseudo-range components of the vector γjB as measured by the first navigation receiver, and a plurality of second weight coefficients Kj,lγR, . . . , Kj,mγR, . . . , Kj,nγR representative of the measurement accuracy of the measured pseudo-range components of the vector γjR as measured by the second navigation receiver; and wherein said step (h) of generating the pseudo-range covariance matrix Rjγ comprises the steps of generating a plurality of third weight coefficients Kj,lγ, . . . Kj,mγ, . . . Kj,nγ from the plurality of first and second weight coefficients, each third weight coefficient Kj,mγ (m=1 to m=n) being generated as a first small number when either of the magnitudes of the corresponding first and second weight coefficients Kj,mγB and Kj,mγR is less than a first threshold value, the magnitude of said first small number being less than the first threshold value, each third weight coefficient Kj,mγ (m=1 to m=n) being generated according to the relationship: (Kj,mγ)−1=(Kj,mγB)−1+(Kj,mγR)−1 when each of the magnitudes of the first and second weight coefficients Kj,mγB and Kj,mγR is greater than the first threshold value, and wherein the matrix Rjγ is generated in the form: 39Rjγ=[(Kj,1γ)-10⋯00(Kj,2γ)-1⋯0⋮⋮⋰⋮00⋯(Kj,nγ)-1].
- 77. A method according to claim 74 wherein said step (g) of generating the main estimation vector {circumflex over (N)}j comprises the steps of:
(h) generating, at each discrete time moment j, a first ambiguity covariance matrix {tilde over (R)}jN representative of the errors in the preliminary estimation vector Ñj; (i) generating, at each discrete time moment j, a second ambiguity covariance matrix Rjy as an initial value for the initial time moment j=1, and in a form equivalent to: RjN=[({tilde over (R)}jN)−1+(Rj−1N)−1]−1 for each time moment j after the initial time moment j=1; (j) generating, at each discrete time moment j, a weighting matrix Wj in a form equivalent to Wj={tilde over (R)}jN·({tilde over (R)}jN+Rj−1N)−1; and (k) generating the main estimation vector {circumflex over (N)}j as a starting value for the initial time moment j=1, and in a form equivalent to: {circumflex over (N)}j=Wj·{circumflex over (N)}j−1+(E−Wj)·Ñj, for each discrete time moment j after the initial time moment j=1, wherein E is the identity matrix.
- 78. A method according to claim 77 wherein the second ambiguity covariance matrix RjN is set to an initial value of R1N={tilde over (R)}1N for the initial time moment j=1;
- 79. A method according to claim 77 wherein the first ambiguity covariance matrix {tilde over (R)}jN for each discrete time moment j is generated by process which provides an equivalent result as the steps of:
(l) forming an observation matrix Hjμ from the geometric Jacobian matrix Hjγ, the matrix Λ−1 of inverse wavelengths, the zero matrix 0, and the identity matrix E in a form comprising four sub-matrices arranged in two rows and two columns: 40Hjμ=[Hjγ0Λ-1·HjγE];(m) generating a phase covariance matrix Rjφ representative of the measurement accuracy of the phase observation vector μjφ; (n) generating a pseudo-range covariance matrix Rjγ representative of the measurement accuracy of the pseudo-range observation vector μjγ; (o) generating an observation covariance matrix Rj from the phase covariance matrix Rjφ, the pseudo-range covariance matrix Rjγ, and the zero matrix 0, in a form comprising four sub-matrices arranged in two rows and two columns: 41Rj=[Rjγ00Rjφ];(p) generating a third ambiguity covariance matrix j in the form: j=[(Hjμ)T·Rj−1·Hjμ]−1; and (q) generating the first ambiguity covariance matrix {tilde over (R)}jN as the sub-matrix comprising the last n rows and last n columns of the third covariance matrix j.
- 80. A method according to claim 77 wherein the first ambiguity covariance matrix {tilde over (R)}jN for each discrete time moment j is generated by the steps of:
(l) generating a phase covariance matrix Rjγ representative of the measurement accuracy of the phase observation vector μjφ; (m) generating a pseudo-range covariance matrix Rjγ representative of the measurement accuracy of the pseudo-range observation vector μjγ; and (n) generating a first ambiguity covariance matrix {tilde over (R)}jN for the preliminary estimation vector Ñj according to the form: {tilde over (R)}jN=Rjφ+Hjφ·[(Hjγ)T·(Rjγ)−1·Hjγ]−1·(Hjφ)T.
- 81. A method according to claim 74 wherein said step (g) of generating the main estimation vector {circumflex over (N)}j comprises the step of generating the main estimation vector {circumflex over (N)}j in the form:
- 82. A method according to claim 74 wherein the discrete time moments j are separated from one another by a time interval TJ which is in the range of 0.1 seconds to 1 second.
- 83. A method according to claim 77 wherein the discrete time moments j are separated from one another by a time interval TJ which is in the range of 0.1 seconds to 1 second.
- 84. A method according to claim 81, wherein the discrete time moments j are separated from one another by a time interval TJ=1 second, and wherein said steps (a) through (g) are performed for a period of time TS which is in the range of 8 seconds to 10 seconds.
- 85. A method according to claim 74 wherein said step (g) of generating the main estimation vector {circumflex over (N)}j comprises the step of generating the main estimation vector {circumflex over (N)}j in the form:
- 86. A method according to claim 85 wherein the first ambiguity covariance matrix {tilde over (R)}jN for each discrete time moment j is generated by process which provides an equivalent result as the steps of:
(o) forming an observation matrix Hjμ from the geometric Jacobian matrix Hjγ, the matrix Λ−1 of inverse wavelengths, the zero matrix 0, and the identity matrix E in a form comprising four sub-matrices arranged in two rows and two columns: 47Hjμ=[Hjγ0Λ-1·HjγE];(p) generating a phase covariance matrix Rjφ representative of the measurement accuracy of the phase observation vector μjφ; (q) generating a pseudo-range covariance matrix Rjγ representative of the measurement accuracy of the pseudo-range observation vector μjγ; (r) generating an observation covariance matrix Rj from the phase covariance matrix Rjφ, the pseudo-range covariance matrix Rjγ, and the zero matrix 0, in a form comprising four sub-matrices arranged in two rows and two columns: 48Rj=[Rjγ00Rjφ];(s) generating a fifth ambiguity covariance matrix j in the form: j=[(Hjμ)T·Rj−1·Hjμ]−1; and (t) generating the first ambiguity covariance matrix {tilde over (R)}jN as the sub-matrix comprising the last n rows and last n columns of the fifth covariance matrix j.
- 87. A method according to claim 85 wherein the first ambiguity covariance matrix {tilde over (R)}jN for each discrete time moment j is generated by the steps of:
(o) generating a phase covariance matrix Rjγ representative of the measurement accuracy of the phase observation vector μjφ; (p) generating a pseudo-range covariance matrix Rjγ representative of the measurement accuracy of the pseudo-range observation vector μjγ; and (q) generating a first ambiguity covariance matrix {tilde over (R)}jN for the preliminary estimation vector Ñj according to the form: {tilde over (R)}jN=Rjφ+Hjφ·[(Hjγ)T·(Rjγ)−1·Hjγ]−1·(Hjφ)T;
- 88. A method according to claim 85 wherein the second ambiguity covariance matrix j* is set to the value of {tilde over (R)}1N for the initial time moment j=1.
- 89. A method according to claim 85 wherein the fourth ambiguity covariance matrix RjN is set to the value of R1N={haeck over (R)}1N for the first iteration.
- 90. A method according to claim 85 wherein the discrete time moments j in steps (a) through (j) are separated from one another by a time interval TJ which is between 0.1 seconds and 1 second; and
wherein the iterations k in steps (k) through (n) are separated from one another by a time interval TS which is between 8 seconds and 10 seconds.
- 91. A method according to claim 76 wherein the measured phases of each component of the phase observation vector μjφ are monitored for the presence of cycle slips;
wherein said method receives an input alarm signal for each component of the phase observation vector μjφ indicating if a cycle slip has occurred in its measured phases; and wherein said step (h) further comprises the step of generating the third weight coefficient Kj,mφ for a component of the phase observation vector μjφ as the first small number when the alarm signal for the component is received.
- 92. A method according to claim 75 further comprising the step of
correcting, for each discrete time moment j, the vector DjR of estimated distances between the satellites and the second navigation receiver (R) on the basis of the components of estimated state vector Aj−1γ generated at the previous-time moment j−1 which comprise the corrections to the baseline coordinates.
- 93. A method according to claim 92 further comprising the step of:
correcting, for each discrete time moment j, the geometric Jacobian matrix Hjγ on the basis of the components of estimated state vector Aj−1γ generated at the previous time moment j−1 which comprise the corrections to the baseline coordinates.
- 94. A method according to claims 74 wherein the first and second receivers are stationary; and
wherein the same geometric Jacobian matrix Hjγ is used for a plurality of discrete time moments j.
CROSS-REFERENCE TO RELATED APPLICATIONS
[0001] This application claims the benefit of priority to U.S. patent application Serial No. 60/100,837, filed Sep. 18, 1998, the contents of which is incorporated herein.
Provisional Applications (1)
|
Number |
Date |
Country |
|
60100837 |
Sep 1998 |
US |
Divisions (2)
|
Number |
Date |
Country |
Parent |
09875066 |
Jun 2001 |
US |
Child |
10226736 |
Aug 2002 |
US |
Parent |
09399077 |
Sep 1999 |
US |
Child |
09875066 |
Jun 2001 |
US |