Each - Draper Laboratory
Each - Draper Laboratory
Each - Draper Laboratory
Create successful ePaper yourself
Turn your PDF publications into a flip-book with our unique Google optimized e-Paper software.
where<br />
dt = 20 ms<br />
S = signal power<br />
R = pseudorandom code correlation function<br />
e = LOS delay error in chips<br />
D = correlator spacing = 0.5 chip<br />
b = bias<br />
n = noise<br />
The bias and noise both derive from squaring the raw I<br />
and Q noise and equations for their distributions may<br />
be derived. The ideal correlation function is:<br />
Finally, the LOS error is modeled as:<br />
38 A Deep Integration Estimator for Urban Ground Navigation<br />
(8)<br />
(9)<br />
(10)<br />
where u is a unit vector from the IMU to the satellite,<br />
dba is the residual atmospheric delay error, and dtR is<br />
user clock residual error.<br />
The DI filter first uses the dz measurements to estimate<br />
the signal-to-noise ratio (SNR), allowing for smooth<br />
adaptation to jamming or low signal strength. Then, the<br />
DI filter performs an update of the filter error state. The<br />
details of this update algorithm are omitted here. Since<br />
the measurement model is highly nonlinear due to the<br />
form of R and its square, common Kalman methods<br />
must be replaced by algorithms from nonlinear estimation<br />
theory. Further discussion is in Ref. [4].<br />
The remaining arrow in Figure 2 shows the low to<br />
medium rate transfer of corrections. After all estimates<br />
are processed for one 10-Hz filter pass (all satellites,<br />
plus radar and altimeter measurements), the error state<br />
is used to calculate these corrections. At the end of the<br />
next 10-Hz interval, the navigation system incorporates<br />
these corrections in a reset. The following items<br />
are reset based on filter error states: position, velocity,<br />
quaternion, gyroscope, and accelerometer compensators,<br />
user clock error estimates, and LOS delay errors<br />
for satellites being tracked.<br />
The two-rate scheme of Figure 2 is critical to the operation<br />
of DI GPS. The data from the filter are not sent<br />
directly to the receiver. Rather, the corrections go to<br />
medium rate, and then indirectly affect NCO commands<br />
via the 10-Hz resets. The 50-Hz receiver control allows<br />
for tracking high-frequency dynamics in the correlators,<br />
while the lower rate filter execution allows for a<br />
more advanced estimation algorithm with more accurate<br />
estimates.<br />
Clock errors: Initialization and reacquisition<br />
Timing and clock errors are critical to deep<br />
integration.<br />
The previous section indicated how the navigation filter<br />
kept up accurate clock error estimates while tracking<br />
satellites in deep integration. Two closely related problems<br />
are clock initialization and clock recapture after<br />
satellite signal loss.<br />
Time is determined in navigation on the basis of highspeed<br />
interrupts from the Rockwell Collins receiver,<br />
referred to as t10 (10 ms apart) and t1000 (1 second<br />
apart). These are driven directly by the receiver<br />
oscillator.<br />
Navigation time, or user time, is based directly on<br />
a count of t10 interrupts. The user clock bias and<br />
frequency errors are defined in speed-of-light units as:<br />
dtR = user time – GPS time<br />
= user time frequency – true frequency<br />
For practical purposes, GPS time is considered perfect.<br />
True frequency is, in speed-of-light units, 1 + Doppler.<br />
As seen above, estimates of these enter into navigationissued<br />
NCO commands. From this follows the deep<br />
integration requirement: clock estimates must always<br />
be within about a chip (approximately 100 ft) of accuracy<br />
to retain code lock in deep integration.<br />
Initialization: At initial operation, the receiver is<br />
in control of its NCOs, and the navigation software<br />
receives t1000 interrupts and messages with the matching<br />
GPS times. The navigation wrapper software does<br />
careful bookkeeping of these data over at least three<br />
low-rate passes (t1000 interrupts). From this, a linear<br />
relationship between user and GPS time can be determined<br />
algebraically. The data are then passed to the<br />
navigation algorithm, which in turn (after navigation<br />
initialization), issues a command to the receiver to<br />
accept host control.<br />
Reacquisition: After a long period of time without visible<br />
GPS satellites, it was found that the receiver clock can<br />
drift nonlinearly to a point well outside the 100-ft accuracy<br />
requirement. An immediate return to DI updates<br />
would result in the loss of lock and poor performance<br />
of the PNS navigator.