The present invention relates to position and time determination in a satellite based navigation receiver, e.g., GPS receiver, under weak signal conditions.
The global positioning system (GPS) is a satellite-based radio-navigation system built and operated by the United States Department of Defense. The system uses twenty-four satellites orbiting the earth at an altitude of about 11,000 miles with a period of about twelve hours. Some additional satellites may be present as spares. These satellites are placed in six different orbits such that at any time a minimum of six satellites are visible at any location on the surface of the earth except in the polar region. Each satellite transmits a time and position signal referenced to an atomic clock. A typical GPS receiver locks onto this signal and extracts the data contained in it. Using signals from a sufficient number of satellites, a GPS receiver can calculate its position, velocity, altitude, and time.
Data is modulated to the GPS signal, in which each data bit spans 20 milliseconds. This data contains ephemeris that provides satellite orbit information and time information to help the receiver determine the system time. Under weak signal conditions, it is still possible for the receiver to acquire and track the GPS signal with a longer non-coherent integration time or other method. However, due to the low signal to noise ratio, the error rate of the decoded GPS broadcast data will be too high making it impossible to determine the signal transmit time. Under this condition, the traditional position calculation method can not be applied.
Some prior art references have been published that deal with the above conditions. The central concept of these methods is adding another variable as system time to compensate for the uncertainty of the signal transmit time. An additional observation measurement is required to help to solve the additional variable. As a result measurements of at least five satellites are needed to calculate the final position.
When the signal transmit time can not be determined, it is impossible to calculate the pseudo-range with the traditional method of multiplying the speed of light with the difference between the signal transmit time and receive time. Because only the C/A code is tracked, only a sub-millisecond fraction of the transmit time can be determined. As a result, the calculated pseudo-range will have 300 km ambiguity, which is the distance the signal travels in one millisecond.
Given an estimated pseudo-range of one satellite ρi, the pseudo-range can be divided into a millisecond part and a sub-millisecond part, ρi=ρi(1)+ρi(2), where
The symbol └ ┘ indicates to take the integer value of the division. The symbol Λ is the distance light travels in 1 ms and is about 300 km. Under weak signal conditions, only the sub-millisecond part ρi(2) can be obtained. The millisecond part ρi(1) can be estimated and used to calculate the pseudo-range ρi by carrying out the following steps:
Make an estimation of the GPS time of signal arrival Tu.
Estimate the travel time of the signal tf. If the travel time can not be estimated, use 70 ms as an approximation for tf.
Calculate the satellite position at time Tu−tf as {right arrow over (s)}i(Tu−tf), where {right arrow over (s)}i( ) is the satellite position as a function of time, which may be derived from ephemeris downloaded onto the receiver.
Use the estimated user position U to calculate the millisecond part of the pseudorange as:
where tu is the receiver clock offset.
Sum the parts ρi(1) and ρi(2) together to get ρi=ρi(1)+ρi(2).
Although a precise determination of the receiver clock offset tu should include the same information as a precise determination of what is here called the GPS time at arrival Tu (in the sense that if you know tu precisely, you should know Tu), the GPS time at arrival as used here likely does not convey the same information as the receiver clock offset. Thus, the GPS time at arrival is treated as independent of the receiver clock offset. By introducing the GPS time at arrival Tu as one additional degree of freedom for the solution of the PVT equation, at least five satellites need to be tracked to solve the PVT. The equations are shown by the following:
At time Tu−tf the position of the ith satellite is {right arrow over (s)}i, and the speed of the ith satellite is {right arrow over (v)}i, where i is used for a satellite index.
The initial receiver position is {right arrow over (û)} and initial clock offset is {circumflex over (t)}u.
An initial range {circumflex over (ρ)}i can be written as {circumflex over (ρ)}i={circumflex over (r)}i+c{circumflex over (t)}u, where {circumflex over (r)}i=∥{right arrow over (s)}i−{right arrow over (û)}∥. The unit vector of {circumflex over (r)}i is
in which {right arrow over (x)}, {right arrow over (y)} and {right arrow over (z)} correspond to the x, y and z axis. The difference between the initial range {circumflex over (ρ)}i and the range ρi to be solved is Δρi={circumflex over (ρ)}−ρi={circumflex over (r)}i+c{circumflex over (t)}u−ρi. The solution using five satellites can be given by:
which gives Δ{right arrow over (ρ)}=HΔ{right arrow over (x)}.
With more than five satellites, we can use least square method to get the solution.
Because of the ambiguity of Λ in the pseudo-range calculation, the estimated user position and time should not be too far away from the true value, otherwise, the millisecond part of ρi(1) will have and incorrect value and result in an incorrect receiver position calculation. This limitation gives a restriction on the initial position and initial time of
Here Tu and {right arrow over (u)} are the true signal arrive time and receiver position respectively, {circumflex over (T)}u and {right arrow over (û)} are estimated initial signal arrive time and receiver position respectively, and κ is the maximum possible pseudo-range change rate (about 710 m/s).
If the above condition can not be met, several methods can be applied to help remove the ambiguity of the pseudo-range. One of these methods is to introduce one or more additional observation measurements so the number of equations in Δ{right arrow over (ρ)}=HΔ{right arrow over (x)} is more than the number of variables. When using the least square method to solve the equations, we can get a residual of the solution. A grid is applied to the possible area covering the possible initial position. With all the possible initial positions and signal arrival times, the residual will reach the global minimum with the correct combination. These combinations should cover the span of all possible estimated signal arrival times and the area around the surface of the earth that can see all the satellites. Because this algorithm searches all the possible solutions and finds the minimum one, the computation time is significant and performing a position fix on an embedded computing system in a limited time is not practical.
Several publications discuss the above methods. A method using five satellites to perform the position fix is disclosed in U.S. Pat. No. 6,215,442 B1, and U.S. Pat. No. 6,437,694 B1 discloses a method using Kalman filter. Methods using six or more satellites that find the minimum residual result as the final solution are described in U.S. Pat. No. 6,417,801 B1 and U.S. Pat. No. 6,734,821 B2. In U.S. Pat. No. 6,865,478 B2, a method is given to reduce the possible initial positions to reduce the computation time. U.S. Pat. No. 6,670,916 gives a height constraint condition so that four satellites can be used to compute the position.
When the initial position and time is unknown or is less accurate such that the condition of
can not be met, none of above methods can be applied to calculate receiver position within a reasonable computation time especially for embedded electrical devices.
Accordingly, there is a need for determining an initial position and time that is accurate enough to be used as a starting point to calculate the receiver position, and that can be performed within a reasonable computation time. This would provide relatively accurate initial position and time to meet the requirement of
to perform further position calculations.
Described herein are systems and methods that are capable of determining receiver position and system time under weak signal conditions.
When the receiver is unable to accurately determine the satellite signal travel time, e.g., due to weak signal reception or some other condition, the receiver can still estimate the pseudo-range for the satellite based on an initial receiver position and system time. In this case, the system and methods described herein provide the necessary initial receiver position and system time with enough accuracy to estimate the pseudo-range, even under weak signal conditions. The receiver can then use the estimated pseudo-range to determine a more accurate receiver position. Preferably, the systems and methods described herein require low computational load, allowing the initial position and time to be computed in real time and/or on embedded systems.
The above and other advantages of embodiments of this invention will be apparent from the following more detailed description when taken in conjunction with the accompanying drawings.
The I and Q components 104 are correlated in correlators 106 with a locally-generated PRN sequence generated by a PN generator 107. The PRN-sequence corresponds to the satellite whose signal is being processed by the baseband section at that time. The PN sequence generator is driven by code NCO 108. The local code frequency is made equal to the code rate of I and Q paths by corrective feedback from the processor 110 to the code NCO 108. In addition, the processor 110 controls the code NCO 108 to set the phase and frequency of local generated PN code. The correlator outputs are then sent to the processor 110 at every millisecond interval. The processor 110 is preferably a digital signal processor (DSP) or a general purpose CPU suitable for high speed arithmetic computations. Subsequent processing of the signals takes place in the processor 110, which then sends the feedback to carrier NCO 105 and code NCO 108. Also, the result of the processor is send to CPU 111, which can be the same one as the processor or a different processor running in parallel. The CPU 111 will derive pseudo-ranges and Doppler measurements using the information of the signal tracking result and then calculate the receiver position. Memory 112, which can include volatile and/or non-volatile memory, is used to store program and data. The ephemeris for the satellites are also stored in the memory 112 or obtained from other sources such as a GSM network.
According to the exemplary receiver illustrated in
where fdi is the Doppler frequency, L is the wavelength of the L1 signal, {right arrow over (s)}i and {right arrow over (v)}i are the position and speed of the ith satellite at time Tu−tf respectively, and {right arrow over (u)} and {right arrow over (v)}u are receiver position and speed respectively. The quantity fdi·L expresses the Doppler in terms of a rate change of the distance between the satellite and receiver with time. The quantity −c{dot over (t)}u takes into account receiver clock drift. In many cases, the receiver is not moving at a very high speed. Thus, some approximations can be applied such as ignoring the speed of the receiver, i.e., assuming {right arrow over (v)}u is zero. This approximation is suitable if the purpose of this method is not to provide very accurate receiver position, but receiver position that is accurate enough to be used as an initial position or starting point in calculations for estimating the pseudo-range. The time of signal travel can also be ignored because the uncertainty of Tu is much more than tf. With these approximation, equation (1) can be simplified to the following:
Here {dot over ({right arrow over (s)}i(Tu) is the derivative of position {right arrow over (s)}i(Tu) and is used as the speed of the satellite at time Tu. The derivate of the satellite position can be calculated using a differential value (compute satellite position at different times and divide by the time difference) or a first derivative equation of the equation used to calculate position.
The receiver position {right arrow over (u)} comprises three dimension coordinate components x, y and z. Including two additional variables, receiver time as Tu and receiver local oscillator frequency bias as {dot over (t)}u, equation (2) can be linearized as
where {circumflex over (x)}, ŷ, {circumflex over (z)}, {circumflex over (T)}u and {dot over ({circumflex over (t)}u are initial values of variables x, y, z, Tu, and {dot over (t)}u respectively. The symbol Δ for a variable indicates the difference between the initial value and the value to be solved. The above linearization is determined by taking a Taylor series expansion of Vi and keeping the first order partial derivative of the expansion.
Some intermediate variables and equations are listed below to simplify the final result.
The equations {circumflex over (r)}xi={circumflex over (x)}−xsi({circumflex over (T)}u),{circumflex over (r)}yi=(ŷ−ysi({circumflex over (T)}u)),{circumflex over (r)}zi=({circumflex over (z)}−zsi({circumflex over (T)}u)) represent the difference of the receiver and the ith satellite coordinates in three dimensions based on the initial values.
The equation {circumflex over (r)}i=∥{right arrow over (û)}−{right arrow over (s)}i({circumflex over (T)}u)∥=√{square root over ({circumflex over (r)}xi2+{circumflex over (r)}yi2+{circumflex over (r)}zi2)} is the geometry distance from the receiver to the ith satellite based on the initial values.
The equation
is radial speed or range change rate of the ith satellite based on the initial values.
The equation ΔVi=fdi·L−Vi({circumflex over (x)},ŷ,{circumflex over (z)},{circumflex over (T)}u,{dot over ({circumflex over (t)}u) is the difference of the measured Doppler and the calculated Doppler based on the initial values.
Based on the above equations, the partial derivatives in equation (3) can be given by:
For five satellites, we can calculate the following matrixes:
These matrixes can be used in the following equation to solve for the receiver position and system time:
V=H·Δx (9)
The above calculation can be repeated over several iterations until the result converges. In this case, the calculated results x, y, z, T, and {dot over (t)}u of one iteration of the calculation are used as the initial values in the next iteration of the calculation and so on. The calculation is repeated until the calculated results are close enough to their corresponding initial values, e.g., such that the results are accurate enough to be used as starting points for estimating the pseudo-range. The final calculated position and time for each satellite may then be used as the initial position and time (starting points) for estimating the pseudo-range for the satellite, e.g., using the methods described in the background.
For the case that there are more than five satellites, we use can use the least square equation Δx=(HTH)−1HTV.
Initial values for {circumflex over (x)}, ŷ, {circumflex over (z)}, {circumflex over (T)}u and {dot over ({circumflex over (t)}u can be based on approximations and the convergence range can be very wide. A reasonable guess of the system time for the first iteration is to use the time-of-ephemeris (toe) of ephemeris stored in memory or the real time clock (RTC) time of the device. The initial receiver position for the first iteration can be a previous known receiver position, e.g., a previously computed position stored in memory. If this position is not available, another method is to calculate the geometrical center of the acquired satellites at the selected time, and use the projection point of this geometrical center on the earth surface as the position. The value of {dot over ({circumflex over (t)}u for the first iteration can be zero.
The above computations may be performed in firmware on the CPU 111 and/or processor 110, or dedicated hardware.
Although the present invention has been described in terms of the presently preferred embodiments, it is to be understood that the disclosure is not to be interpreted as limiting. Various alterations and modifications will no doubt become apparent to those skilled in the art after having read this disclosure. For example, although the above embodiments have been described using the GPS system as an example, the techniques and methods may be used for other global satellite navigational systems including GLONASS, Galileo, secondary systems such as WASS, EGNOS, and MSAS, as well as hybrids of the above systems. Accordingly, it is intended that the appended claims be interpreted as covering all alterations and modifications as fall within the spirit and scope of the invention.