Vous êtes sur la page 1sur 33

Navigation and Guidance

Dr. Shashi Ranjan Kumar

Assistant Professor
Department of Aerospace Engineering
Indian Institute of Technology Bombay
Powai, Mumbai, 400076 India

Dr. Shashi Ranjan Kumar IITB-AE 410/641 Lecture 8 Navigation and Guidance 1 / 33
Navigation and Guidance
Geometric Effects

Ranging error alone does not determine position fix error.


Relative geometry of four satellites and user also affects fix accuracy.
Due to linearity of navigation equation, relationship between errors in
pseudorange measurement and in user position and clock bias are given by

x = B −1 r

where, x and r are errors in user position and clock bias, and pseudorange
measurement errors, respectively.
If the covariance matrices for errors x and r as Cx and Cr , respectively,
then

Cx = B −1 Cr B −T

Dr. Shashi Ranjan Kumar IITB-AE 410/641 Lecture 8 Navigation and Guidance 2 / 33
Navigation and Guidance
Geometric Effects

B is function of the direction cosines of the LOS unit vectors from the user
to four satellites and user’s clock bias.
Error relationships are functions only of the satellite geometry.
Geometric dilution of precision (GDOP): A measure of how satellite geometry
degrades navigation accuracy.
To a good approximation,

Cx = (B T B)−1

Covariance matrix depends only on the direction and is in no way dependent


on the distances between the user and each satellite. How can we say this?
Diagonal elements of covariance matrix are actually the variances of user
position and time.

Dr. Shashi Ranjan Kumar IITB-AE 410/641 Lecture 8 Navigation and Guidance 3 / 33
Navigation and Guidance
Geometric Effects

Geometric dilution of precision (GDOP): A measure of the error


contributed by the geometric relationships of the GPS as seen by the receiver.
q p
GDOP = tr(B T B)−1 = Vx + Vy + Vz + Vt

where, Vx , Vy , Vz , Vt are variance of x, y, z position (or velocity), and clock


bias estimates, respectively.
Diagonal of the covariance matrix contains the variances of the position
errors and the receiver-clock bias error.
q
GDOP = σxx 2 + σ2 + σ2 + σ2
yy zz tt

where σxx , σyy , σzz , σtt represent error variance in position and time,
respectively.
GDOP is the conventional measure of overall geometric performance.

Dr. Shashi Ranjan Kumar IITB-AE 410/641 Lecture 8 Navigation and Guidance 4 / 33
Navigation and Guidance
Geometric Effects

3D position dilution of precision (PDOP): A measure of geometric


performance which relates only to three components of position error.
Product of PDOP and ranging error determines fix error.
Its numerical value ranges between 1.5 and ∞
Receiver normally attempts to track the set of four among N visible satellites
that has the smallest PDOP.
PDOP is also invariant with the coordinate system.
In any navigation system, position accuracy is more important and knowing
time is a secondary by-product.
p q
PDOP = Vx + Vy + Vz = σxx 2 + σ2 + σ2
yy zz

PDOP is useful in aircraft weapon delivery applications.

Dr. Shashi Ranjan Kumar IITB-AE 410/641 Lecture 8 Navigation and Guidance 5 / 33
Navigation and Guidance
Geometric Effects

Position accuracy
⇒ PDOP: User/navigation satellite geometries and it can be analyzed
independently of system errors.
⇒ Other “system” errors: Accuracy of the ephemeris data and transmitted time
from the satellites, ionospheric and atmospheric effects, and various other
error sources.
Characteristic of PDOP allows separate analyses of alternative orbital
configurations, user motion, and satellite losses sustained for the purposes of
comparison and choosing optimal constellation.
What could be other alternative DOPs?
⇒ Horizontal dilution of precision (HDOP)
⇒ Altitude or vertical dilution of precision (VDOP)
⇒ Time dilution of precision (TDOP)
⇒ Maximum dilution of precision (MDOP): Larger component of horizontal
position error

Dr. Shashi Ranjan Kumar IITB-AE 410/641 Lecture 8 Navigation and Guidance 6 / 33
Navigation and Guidance
Geometric Effects

Horizontal dilution of precision (HDOP)


p q
HDOP = Vx + Vy = 2 + σ2
σxx yy

Altitude or vertical dilution of precision (VDOP)


p p
VDOP = Vz = σzz 2

Time dilution of precision (TDOP)


p q
TDOP = 2
Vt = σtt

Maximum dilution of precision (MDOP)


p p p q
2 ,
MDOP = max{ Vx , Vy } = max{ σxx 2 }
σyy

HDOP is mostly used in surface application.


Dr. Shashi Ranjan Kumar IITB-AE 410/641 Lecture 8 Navigation and Guidance 7 / 33
Navigation and Guidance
Geometric Effects

DOP depends on satellite’s geometric configuration.


How to select the optimal satellite configuration?
⇒ Satellites with most favourable geometry w.r.t. the user.
Majority of the time, however, there will be six or more satellites in view by
an earth based user and even more by a low altitude satellite user.
Time required to compute PDOP values for all the possible combinations of
satellites is excessive.
This may not be a good option for satellite selection.
Almost total correlation between PDOP and the volume of the tetrahedron
formed by lines connecting the tips of the four unit vectors from the user
toward the four satellites.
Larger the volume of this tetrahedron, smaller the corresponding PDOP value
will be for this set of satellites.

Dr. Shashi Ranjan Kumar IITB-AE 410/641 Lecture 8 Navigation and Guidance 8 / 33
Navigation and Guidance
Satellite Selection based on Geometry

Figure: Geometry for the determination of PDOP: (a) good (low) PDOP; (b) poor
(high) PDOP.

Dr. Shashi Ranjan Kumar IITB-AE 410/641 Lecture 8 Navigation and Guidance 9 / 33
Navigation and Guidance
Least-Square Navigation Solution

Navigation measurements
⇒ Geometry
⇒ Incoming signal
⇒ Noise
Selection based on GDOP does not address incoming signal and noise.
An optimum satellite selection process must use every available piece of
information available to determine the satellite set with minimum error.
GDOP is given by
q
GDOP = tr(H T H)−1

Matrix H is formed with the direction cosines of LOS unit vector from the
user to each satellite in view.

Dr. Shashi Ranjan Kumar IITB-AE 410/641 Lecture 8 Navigation and Guidance 10 / 33
Navigation and Guidance
Least-Square Navigation Solution

Visibility matrix, H, is given by


 
hE (1) hN (1) hu (1) 1
 hE (2) hN (12) hu (2) 1 
H=
 
.. .. .. .. 
 . . . . 
hE (j) hN (j) hu (j) 1

where, j is total number of visible satellites and hE (.), hn (.), hu (.) are the
respective direction cosines of LOS unit vectors to each satellite expressed in
user local-level (east, north, up) coordinates.
Because of variations in geographic terrain, all satellites below 5◦ elevation
from the horizon are deleted from possible satellite selection.
Satellite set with lowest GDOP is selected for smallest navigation errors.

Dr. Shashi Ranjan Kumar IITB-AE 410/641 Lecture 8 Navigation and Guidance 11 / 33
Navigation and Guidance
Least-Square Navigation Solution

Consider vector of measurement components, z, corrupted by additive noise


v and linearly related to the state x.

z = Hx + v

Least square estimator x̂ which minimizes the sum squared of the


components of the difference z − Hx.

x̂ = argx min J, J = (z − Hx)T (z − Hx)

On solving this optimization problem, we get

x̂ = (H T H)−1 H T z

In case of deterministic case, v = 0, the matrix B corresponds to visibility


matrix, x, r correspond to state and measurement vectors.

Dr. Shashi Ranjan Kumar IITB-AE 410/641 Lecture 8 Navigation and Guidance 12 / 33
Navigation and Guidance
Least-Square Navigation Solution

To obtain the quality of estimate, define error as x̃ = x̂ − x

x̃ = (H T H)−1 H T (Hx + v) − x = (H T H)−1 H T v

If the noise has zero mean then estimator error also has zero mean.
Covariance of the estimation error
h i
E x̃x̃T = (H T H)−1 H T E vv T H(H T H)−1
 

If all components of v are pairwise uncorrelated and have unit variance then
(
1 i=j
, E vv T = I
 
E [vi vj ] = δij =
0 i 6= j

This results into


h i
E x̃x̃T = (H T H)−1 H T H(H T H)−1 = (H T H)−1

Dr. Shashi Ranjan Kumar IITB-AE 410/641 Lecture 8 Navigation and Guidance 13 / 33
Navigation and Guidance
Least-Square Navigation Solution

Square root of tr[(H T H −1 )] will be recognized as the GDOP.


All GDOP related performance measures is estimated as navigation quantity
per unit of measurement noise covariance.
In cases where certain measurement components are noisier than others, then
GDOP may not be very useful due to per unit measurement noise concept.
If choice exists between two possible sets or measurements, the set with
poorer GDOP may be preferable, if they are of sufficiently higher accuracy.
 
If measurement covariance matrix is not unity matrix but E vv T = Iσ 2
then GDOP increases by scalar σ 2 .
If all potential measurements have same covariance then choice of best
measurement set will be based on best GDOP.
Measurement noise is called nonuniform when different measurements have
different noise levels.

Dr. Shashi Ranjan Kumar IITB-AE 410/641 Lecture 8 Navigation and Guidance 14 / 33
Navigation and Guidance
Least-Square Navigation Solution

For nonuniform noise levels, we obtain estimate by using weighted cost


function

x̂ = argx min J, J = (z − Hx)T W (z − Hx)

where

W = R−1 , R = E[vv T ]

More weights to accurate measurements and less to the noisy ones.


On solving this optimization problem, we have estimates

x̂ = (H T R−1 H)−1 H T R−1 z (Verify)

and the covariance matrix becomes


h i
E x̃x̃T = (H T R−1 H)−1 (Verify)

Dr. Shashi Ranjan Kumar IITB-AE 410/641 Lecture 8 Navigation and Guidance 15 / 33
Navigation and Guidance
Least-Square Navigation Solution

Psuedorange measurements

ρi = Ri + c∆tAi + c(∆tu − ∆tSi )

where, ∆tSi , ∆tui , ∆tAi denote


clock offset of ith satellite and user
clock offset bias from GPS system
time, and propagation delay and
other errors, respectively.
Define 1i as LOS unit vector from
user to ith satellite

1i · D i = |D i | = Di

Also, we can write Ru = Ri − D i where Di = kxi − xk

1i .Ru =1i · Ri − 1i · D i
=1i · Ri − Di
Dr. Shashi Ranjan Kumar IITB-AE 410/641 Lecture 8 Navigation and Guidance 16 / 33
Navigation and Guidance
Least-Square Navigation Solution

Term Di can be expressed as

Di = ρi − Bu − Bi

where Bu , Bi are user range clock offset and satellite range clock offset,
respectively.
On substituting for Di , we get

1i · Ru =1i .Ri − Di = 1i · Ri − ρi + Bu + Bi
1i · Ru − Bu = 1i · Ri − ρi + Bi
| {z } | {z }
Unknown terms Known terms

For deterministic case,


1T1
 
1
 1T2
 
1  Ru
z 4×1 =
 1T3
 ⇒ x̂ = H −1 z
1  −Bu 4×1
1T4 1 4×4 | {z }

Dr. Shashi Ranjan Kumar IITB-AE 410/641 Lecture 8 Navigation and Guidance 17 / 33
Navigation and Guidance
Differential GPS

Differential GPS: Improvement of performance of GPS position


⇒ Use of data from GPS reference receiver (RR) in the vicinity of GPS receiver
equipped user.
⇒ Reference receiver at a known location measure satellite location.
⇒ Determination of common-mode bias errors using GPS reference receiver.
⇒ Compensate for such errors to get correct user’s position measurements.
Correction of the measurements of other GPS receivers within a specified
area around RR.
Measured range includes actual range to satellite and associated errors.
Errors include satellite clock error, tropospheric delay and ionospheric delay.
As the coordinates of RR is known, its range can be calculated by using
ephemeris data.
Other errors can be estimated from the difference between measured and
calculated range.

Dr. Shashi Ranjan Kumar IITB-AE 410/641 Lecture 8 Navigation and Guidance 18 / 33
Navigation and Guidance
Differential GPS

Figure: Differential GPS concept.

Dr. Shashi Ranjan Kumar IITB-AE 410/641 Lecture 8 Navigation and Guidance 19 / 33
Navigation and Guidance
Differential GPS

True values of reference receiver’s navigation fix are compared against


measured values, and differences become the differential corrections.
These corrections may be transmitted to area user sets in real-time, or they
may be recorded for post mission use.
In either case, the users apply corrections to their navigation data in order to
produce position fixes that are free of GPS-related biases.
Schemes to accomplish differential GPS navigation
⇒ Combinations of either corrections of pseudoranges, or of the navigation
solutions
⇒ Whether the corrections are made on board the user vehicle or at the RR
To accommodate large number of user vehicles, uplink of pseudorange
corrections for participant onboard processing is used.
RR measures pseudoranges to all visible satellites and computes differences
between the calculated range to the satellite and the measured range.

Dr. Shashi Ranjan Kumar IITB-AE 410/641 Lecture 8 Navigation and Guidance 20 / 33
Navigation and Guidance
Differential GPS

These differences are taken after the receiver clock bias has been removed .
To compute range to each satellite, the satellite’s position is defined in the
ephemeris message.
As in GPS, users select the optimum set of four satellites for measurements.
Difference between RR’s navigation solution and survey coordinates is called
as the “ground truth”.
Ground truth represents navigation error in east, north, and vertical
components.
DGPS represents a cost-effective method which significantly improves the
reliability and accuracy of GPS navigation.
Other techniques
⇒ Addition of extra sensors
⇒ Use of pseudo-satellites (pseudolites)
⇒ Assisted GPS

Dr. Shashi Ranjan Kumar IITB-AE 410/641 Lecture 8 Navigation and Guidance 21 / 33
Navigation and Guidance
Types of Differential GPS

A single reference
station (RS) serving in
small area
Compute corrections
based on differential
GPS concept
Corrections are more
accurate for users
nearby
For users far way from
RS, it may not be
effective. Figure: Local Area Differential GPS (LADGPS)

Dr. Shashi Ranjan Kumar IITB-AE 410/641 Lecture 8 Navigation and Guidance 22 / 33
Navigation and Guidance
Types of Differential GPS

Error correlation decreases with


distance from RS in DGPS
Improvement using more RS along
perimeter of single RS
Receiver weights corrections based on
its proximity
1 Master station (MS) and several RS
RS transfers measurements to MS and
then MS estimates GPS error
Update of corrections to users
⇒ Space based augmentation systems
(SBAS) Figure: Wide Area Differential GPS
⇒ Ground based augmentation systems (WADGPS)
(GBAS)

Dr. Shashi Ranjan Kumar IITB-AE 410/641 Lecture 8 Navigation and Guidance 23 / 33
Navigation and Guidance
Assisted GPS

For cellular phones, GPS may not be always on.


Requirement of fresh satellite data for position fixing.
Receiver goes in search mode, takes longer time to get first fix.
Longer time may not be acceptable for emergency services.

Figure: Time to First Fix (TTFF) for Various Aiding Data

Dr. Shashi Ranjan Kumar IITB-AE 410/641 Lecture 8 Navigation and Guidance 24 / 33
Navigation and Guidance
Assisted GPS

Figure: Assisted GPS (AGPS)

 Aiding data to GPS receiver through mobile communication or internet


 Segments of AGPS
Network of reference GPS receivers
Central server
Communication media (radio or internet)
Receiver with capability to process AGPS data
Dr. Shashi Ranjan Kumar IITB-AE 410/641 Lecture 8 Navigation and Guidance 25 / 33
Navigation and Guidance
Errors in GPS

(a) Ionosphere and Troposphere (b) Multipath Distortion

Figure: Error Sources in GPS

Troposphere cause reduction in speed of light due to refractivity and causes


range error by 2.5-25 m depending on elevation angle
Multipath distortions cause error of about 10 m in range measurement.
Dr. Shashi Ranjan Kumar IITB-AE 410/641 Lecture 8 Navigation and Guidance 26 / 33
Navigation and Guidance
GPS/INS Integration

GPS and INS has complementary features which allows to integrate both for
improved performance.
GPS can operate with sufficient accuracy in a stand-alone configuration.
INS is able to provide accurate aiding data on short-term vehicle dynamics,
while the GPS provides accurate data on long-term vehicle dynamics.
GPS receiver provides pseudorange and pseudorange rate: useful for
estimating errors in position, velocity, and other error parameters of the INS
and GPS receiver clock.
Estimates of INS error parameters allow GPS/INS navigation to achieve
substantially smaller errors than could be achieved with either a GPS or an
INS operating alone.
Optimal integration of GPS-aided INS: Both INS and GPS jointly providing
raw data to a single Kalman filter.
Even though INS and/or GPS may become unstable, Kalman filter remains
stable if filter estimates all modelled error with a bounded error.

Dr. Shashi Ranjan Kumar IITB-AE 410/641 Lecture 8 Navigation and Guidance 27 / 33
Navigation and Guidance
GPS/INS Integration

Dr. Shashi Ranjan Kumar IITB-AE 410/641 Lecture 8 Navigation and Guidance 28 / 33
Navigation and Guidance
GPS/INS Integration

INS provides GPS with a reference that is corrected by the Kalman filter.
Estimated parameters are combined with the INS measured position, velocity,
and attitude to generate the best estimates of system position, velocity, and
attitude.
Accuracy of the GPS solution degrades rapidly whenever lock is lost in one or
more satellites.
It can be avoided if INS is integrated with GPS.
Primary benefit of filtering GPS data through the INS is not to improve on
the accuracy of the GPS position and velocity but to optimize the system
solution in case a GPS outage occurs.
GPS/INS have reduced sensitivity to jamming and maneuvers in military
applications.
Initial alignment and subsequent flight calibration of INS information is
necessary.

Dr. Shashi Ranjan Kumar IITB-AE 410/641 Lecture 8 Navigation and Guidance 29 / 33
Navigation and Guidance
Navigation Steering: Open Loop

Dr. Shashi Ranjan Kumar IITB-AE 410/641 Lecture 8 Navigation and Guidance 30 / 33
Navigation and Guidance
Navigation Steering: Closed Loop

Dr. Shashi Ranjan Kumar IITB-AE 410/641 Lecture 8 Navigation and Guidance 31 / 33
Navigation and Guidance
Navigation Steering

 Shortest path between two points


on Earth: Path along great circle
passing through two points
 Great circle: A circle on surface of
sphere, of which the plane of circle
passes through center of sphere.
 A unique great circle between two
points unless they are diametrically
opposite.
 Pole of great circle
 Small circle: Circle which does not
pass through center, lower radius
than great circle

Dr. Shashi Ranjan Kumar IITB-AE 410/641 Lecture 8 Navigation and Guidance 32 / 33
Navigation and Guidance
Text/References

Reference
1 G. M. Siouris, Aerospace Avionics Systems: A Modern Synthesis, Academic
Press, Inc. 1993.

Thank you for your attention !!!

Dr. Shashi Ranjan Kumar IITB-AE 410/641 Lecture 8 Navigation and Guidance 33 / 33

Vous aimerez peut-être aussi