Methods and apparatuses of estimating the position of a mobile user in a system of satellite differential navigation
First Claim
1. A method of estimating a set of floating ambiguities associated with a set of phase measurements of a plurality n of satellite carrier signals made by a first navigation receiver (B) and a second navigation receiver (R) separated by a distance, wherein a baseline vector (xo,yo,zo) relates the position of the second receiver to the first receiver, each satellite carrier signal being transmitted by a satellite and having a wavelength, 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, said method receiving, for a plurality of two or more time moments j, the following inputs:
- a vector γ
jB representative 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 representative 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 representative of a plurality of estimated distances between the satellites and the first navigation receiver (B),a vector DjR representative of a plurality of estimated distances between the satellites and the second navigation receiver (R),a vector φ
jB representative of a plurality of full phase measurements of the satellite carrier signals measured by the first navigation receiver (B),a vector φ
jR representative 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 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 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) generating, for time moment j=1, an LU-factorization of a matrix M1 or a matrix inverse of matrix M1, the matrix M1 being a function of at least Λ
−
1 and H1γ
,(d) generating, for time moment j=1, a vector N1 as a function of at least Δ
γ
1, Δ
φ
1, and the LU-factorization of matrix M1 or the matrix inverse of matrix M1;
(e) generating, for an additional time moment j≠
1, an LU-factorization of a matrix Mj or a matrix inverse of matrix Mj, the matrix Mj being a function of at least Λ
−
1, Hjγ
and an instance of matrix M generated for a different time moment; and
(f) generating, for an additional time moment j≠
1, a vector Nj as a function of at least Δ
γ
j, Δ
φ
j, and the LU-factorization or matrix Mj or the matrix inverse of matrix Mj, the vector Nj having estimates of the floating ambiguities.
1 Assignment
0 Petitions
Accused Products
Abstract
Disclosed are methods and apparatuses for estimating the floating ambiguities associated with the measurement of the carrier signals of a plurality of global positioning satellites, such that the floating ambiguities are preferably consist for a plurality of different time moments. In one aspect of the invention, a real-time iterative matrix refactorization process is provided which reduces processor load and retains history of the measurements.
-
Citations
51 Claims
-
1. A method of estimating a set of floating ambiguities associated with a set of phase measurements of a plurality n of satellite carrier signals made by a first navigation receiver (B) and a second navigation receiver (R) separated by a distance, wherein a baseline vector (xo,yo,zo) relates the position of the second receiver to the first receiver, each satellite carrier signal being transmitted by a satellite and having a wavelength, 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, said method receiving, for a plurality of two or more time moments j, the following inputs:
-
a vector γ
jB representative 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 representative 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 representative of a plurality of estimated distances between the satellites and the first navigation receiver (B), a vector DjR representative of a plurality of estimated distances between the satellites and the second navigation receiver (R), a vector φ
jB representative of a plurality of full phase measurements of the satellite carrier signals measured by the first navigation receiver (B),a vector φ
jR representative 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 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 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) generating, for time moment j=1, an LU-factorization of a matrix M1 or a matrix inverse of matrix M1, the matrix M1 being a function of at least Λ
−
1 and H1γ
,(d) generating, for time moment j=1, a vector N1 as a function of at least Δ
γ
1, Δ
φ
1, and the LU-factorization of matrix M1 or the matrix inverse of matrix M1;(e) generating, for an additional time moment j≠
1, an LU-factorization of a matrix Mj or a matrix inverse of matrix Mj, the matrix Mj being a function of at least Λ
−
1, Hjγ
and an instance of matrix M generated for a different time moment; and(f) generating, for an additional time moment j≠
1, a vector Nj as a function of at least Δ
γ
j, Δ
φ
j, and the LU-factorization or matrix Mj or the matrix inverse of matrix Mj, the vector Nj having estimates of the floating ambiguities.- View Dependent Claims (2, 3, 4, 5, 6, 7, 8, 9, 10, 11, 12, 13, 14, 15, 16, 17)
-
-
7. The method of claim 3 wherein weighting matrix R1 comprises an identity matrix multiplied by a scalar quantity.
-
8. The method of claim 5 wherein the distance between the first and second navigation receivers is constrained to a distance LRB, wherein step (e) generates matrix Sj in a form equivalent to:
-
9. The method of claim 5 wherein the weighting matrix Rj comprises an identity matrix multiplied by a scalar quantity for at least one time moment j.
-
10. The method of claim 4 wherein the generation of the LU-factorization in step (e) comprises the steps of:
-
(g) generating an LU-factorization of matrix Mj−
1 in a form equivalent to Lj−
1Lj−
1T wherein Lj−
1 is a low-triangular matrix and Lj−
1T is the transpose of Lj−
1;(h) generating a factorization of GTPjG in a form equivalent to TjTjT=GTPjG, where TjT is the transpose of Tj; (i) generating an LU-factorization of matrix Mj in a form equivalent to LjLjT from a plurality n of rank-one modifications of matrix Lj−
1, each rank-one modification being based on a respective column of matrix Tj, where n is the number of rows in matrix Mj.
-
-
11. The method of claim 10 wherein step (h) generates matrix Tj from a Cholesky factorization of GTPjG.
-
12. The method of claim 10 wherein weighting matrix Rj has a form equivalent to:
-
13. The method of claim 10 wherein weighting matrix Rj is applied to a case where there is a first group of satellite signals having carrier signals in a first wavelength band and a second group of satellite signals having a carrier signals in a second wavelength band, the weighting frequency having a form equivalent to:
-
14. The method of claim 4 wherein step (d) comprises generating a vector B1 to comprise a vector having a form equivalent to GTP1μ
-
1+qg1, where the vector μ
1 comprises the vector [Δ
γ
1, Δ
φ
1]T, and where the quantity qgj is a zero vector when the distance between the first and second navigation receivers is unconstrained and where q may be non-zero and gj may be a non-zero vector when the distance between the first and second navigation receivers is constrained; andwherein step (f) further comprises generating, for each time moment j≠
1, a vector Bj to comprise a matrix having a form equivalent to Bj−
1+GTPjμ
j+qgi, where the vector μ
j comprises the vector [Δ
γ
j, Δ
φ
j]T, and where the vector Bj−
1 is the vector B1 generated by step (d) when j=2 and comprises the vector generated by step (f) for the for the j−
1 time moment when j>
2, and where the quantity qgj is a zero vector when the distance between the first and second navigation receivers is unconstrained and where q may be non-zero and gj may be a non-zero vector when the distance between the first and second navigation receivers is constrained; andwherein step (f) further comprises generating vector Nj to comprise a vector having a form equivalent to Nj=[Mj]−
1Bj, where the matrix Mj−
1 comprises an inverse of matrix of matrix Mj.
-
1+qg1, where the vector μ
-
15. The method of claim 14 wherein the distance between the first and second navigation receivers is constrained to a distance LRB, wherein step (c) generates matrix S1 in a form equivalent to:
-
16. The method of claim 14 wherein the distance between the first and second navigation receivers is constrained to a distance LRB, wherein step (e) generates matrix Sj in a form equivalent to:
-
17. The method of claim 14 wherein the weighting matrix Rj comprises an identity matrix multiplied by a scalar quantity for at least one time moment j.
-
18. A method of estimating a set of floating ambiguities associated with a set of phase measurements of a plurality n of satellite carrier signals made by a first navigation receiver (B) and a second navigation receiver (R), wherein a baseline vector (xo,yo,zo) relates the position of the second receiver to the first receiver, each satellite carrier signal being transmitted by a satellite and having a wavelength, 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, said method receiving, for a plurality of two or more time moments j, the following inputs for each time moment j:
-
a vector γ
jB representative 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 representative 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 representative of a plurality of estimated distances between the satellites and the first navigation receiver (B), a vector DjR representative of a plurality of estimated distances between the satellites and the second navigation receiver (R), a vector φ
jB representative of a plurality of full phase measurements of the satellite carrier signals measured by the first navigation receiver (B),a vector φ
jR representative 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 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), said step generating a set of range residuals Δ
γ
k, k=1, . . . , j;(b) generating, for each 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, said step generating a set of phase residuals Δ
φ
k, k=1, . . . , j;(c) generating an LU-factorization of a matrix M or a matrix inverse of matrix M, the matrix M being a function of at least Λ
−
1 and Hkγ
, for index k of Hkγ
covering at least two of the time moments j;(d) generating a vector N of estimated floating ambiguities as a function of at least the set of range residuals Δ
γ
k, the set of phase residuals Δ
φ
k, and the LU-factorization of matrix M or the matrix inverse of matrix M. - View Dependent Claims (19, 20, 21, 22)
-
-
23. A computer program product for directing a data processor to estimate a set of floating ambiguities associated with a set of phase measurements of a plurality n of satellite carrier signals made by a first navigation receiver (B) and a second navigation receiver (R) separated by a distance, wherein a baseline vector (xo,yo,zo) relates the position of the second receiver to the first receiver, each satellite carrier signal being transmitted by a satellite and having a wavelength, 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, the process receiving, for a plurality of two or more time moments j, the following inputs:
-
a vector γ
jB representative 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 representative 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 representative of a plurality of estimated distances between the satellites and the first navigation receiver (B), a vector DjR representative of a plurality of estimated distances between the satellites and the second navigation receiver (R), a vector φ
jB representative of a plurality of full phase measurements of the satellite carrier signals measured by the first navigation receiver (B),a vector φ
jR representative 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, the computer program product comprising;a computer-readable medium; a first set of instructions embodied on the computer-readable medium which directs the data processor to generate, for each 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);a second set of instructions embodied on the computer-readable medium which directs the data processor to generate, for each 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;a third set of instructions embodied on the computer-readable medium which directs the data processor to generate, for time moment j=1, an LU-factorization of a matrix M1 or a matrix inverse of matrix M1, the matrix M1 being a function of at least Λ
−
1 and H1γ
;a fourth set of instructions embodied on the computer-readable medium which directs the data processor to generate, for time moment j=1, a vector N1 as a function of at least Δ
γ
1, Δ
φ
1, and the LU-factorization of matrix M1 or the matrix inverse of matrix M1;a fifth set of instructions embodied on the computer-readable medium which directs the data processor to generate, for an additional time moment j≠
1, an LU-factorization of a matrix Mj or a matrix inverse of matrix Mj, the matrix Mj being a function of at least Λ
−
1 and Hjγ
; anda sixth set of instructions embodied on the computer-readable medium which directs the data processor to generate, for an additional time moment j≠
1, a vector Nj as a function of at least Δ
γ
j, Δ
φ
j, and the LU-factorization or matrix Mj or the matrix inverse of matrix Mj, the vector Nj having estimates of the floating ambiguities. - View Dependent Claims (24, 25, 26, 27, 28, 29, 30, 31, 32)
-
-
33. A computer program product for directing a data processor to estimate a set of floating ambiguities associated with a set of phase measurements of a plurality n of satellite carrier signals made by a first navigation receiver (B) and a second navigation receiver (R) separated by a distance, wherein a baseline vector (xo,yo,zo) relates the position of the second receiver to the first receiver, each satellite carrier signal being transmitted by a satellite and having a wavelength, 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, the process receiving, for a plurality of two or more time moments j, the following inputs:
-
a vector γ
jB representative 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 representative 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 representative of a plurality of estimated distances between the satellites and the first navigation receiver (B), a vector DjR representative of a plurality of estimated distances between the satellites and the second navigation receiver (R), a vector φ
jB representative of a plurality of full phase measurements of the satellite carrier signals measured by the first navigation receiver (B),a vector φ
jR representative 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, the computer program product comprising;a computer-readable medium; a first set of instructions embodied on the computer-readable medium which directs the data processor to generate, for each 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);a second set of instructions embodied on the computer-readable medium which directs the data processor to generate, for each 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;a third set of instructions embodied on the computer-readable medium which directs the data processor to generate an LU-factorization of a matrix M or a matrix inverse of matrix M, the matrix M being a function of at least Λ
−
1 and Hkγ
, for index k of Hkγ
covering at least two of the time moments j; anda fourth set of instructions embodied on the computer-readable medium which directs the data processor to generate a vector N of estimated floating ambiguities as a function of at least the set of range residuals Δ
γ
k, the set of phase residuals Δ
φ
k, and the LU-factorization of matrix M or the matrix inverse of matrix M. - View Dependent Claims (34, 35, 36)
-
-
37. An apparatus for estimating a set of floating ambiguities associated with a set of phase measurements of a plurality n of satellite carrier signals made by a first navigation receiver (B) and a second navigation receiver (R) separated by a distance, wherein a baseline vector (xo,yo,zo) relates the position of the second receiver to the first receiver, each satellite carrier signal being transmitted by a satellite and having a wavelength, 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, said apparatus receiving, for a plurality of two or more time moments j, the following inputs:
-
a vector γ
jB representative 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 representative 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 representative of a plurality of estimated distances between the satellites and the first navigation receiver (B), a vector DjR representative of a plurality of estimated distances between the satellites and the second navigation receiver (R), a vector φ
jB representative of a plurality of full phase measurements of the satellite carrier signals measured by the first navigation receiver (B),a vector φ
jR representative 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 apparatus comprising; (a) means for generating, for each 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) means for generating, for each 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) means for generating, for time moment j=1, an LU-factorization of a matrix M1 or a matrix inverse of matrix M1, the matrix M1 being a function of at least Λ
−
1 and H1γ
;(d) means for generating, for time moment j=1, a vector N1 as a function of at least Δ
γ
1, Δ
φ
1, and the LU-factorization of matrix M1 or the matrix inverse of matrix M1;(e) means for generating, for an additional time moment j≠
1, an LU-factorization of a matrix Mj or a matrix inverse of matrix Mj, the matrix Mj being a function of at least Λ
−
1 and Hjγ
; and(f) means for generating, for an additional time moment j≠
1, a vector Nj as a function of at least Δ
γ
j, Δ
φ
j, and the LU-factorization or matrix Mj or the matrix inverse of matrix Mj, the vector Nj having estimates of the floating ambiguities. - View Dependent Claims (38, 39, 40, 41, 42, 43, 44, 45, 46, 47)
-
-
48. An apparatus for estimating a set of floating ambiguities associated with a set of phase measurements of a plurality n of satellite carrier signals made by a first navigation receiver (B) and a second navigation receiver (R) separated by a distance, wherein a baseline vector (xo,yo,zo) relates the position of the second receiver to the first receiver, each satellite carrier signal being transmitted by a satellite and having a wavelength, 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, said apparatus receiving, for a plurality of two or more time moments j, the following inputs:
-
a vector γ
jB representative 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 representative 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 representative of a plurality of estimated distances between the satellites and the first navigation receiver (B), a vector DjR representative of a plurality of estimated distances between the satellites and the second navigation receiver (R), a vector φ
jB representative of a plurality of full phase measurements of the satellite carrier signals measured by the first navigation receiver (B),a vector φ
jR representative 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 apparatus comprising; (a) means for generating, for each 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), said means generating a set of range residuals Δ
γ
k, k=1, . . . , j;(b) means for generating, for each 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, said means generating a set of phase residuals Δ
φ
k, k=1, . . . , j;(c) means for generating an LU-factorization of a matrix M or a matrix inverse of matrix M, the matrix M being a function of at least Λ
−
1 and Hkγ
, for index k of Hkγ
covering at least two of the time moments j;(d) means for generating a vector N of estimated floating ambiguities as a function of at least the set of range residuals Δ
γ
k, the set of phase residuals Δ
φ
k, and the LU-factorization of matrix M or the matrix inverse of matrix M. - View Dependent Claims (49, 50, 51)
-
Specification