13.01.2013 Views

Each - Draper Laboratory

Each - Draper Laboratory

Each - Draper Laboratory

SHOW MORE
SHOW LESS

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.

Hooray! Your file is uploaded and ready to be published.

Saved successfully!

Ooh no, something went wrong!