Professional Documents
Culture Documents
6 - 17 May 2013
RAQUET John
Air Force Institute of Technology
2950 Hobson Way, BLDG. 641, Wright Patternson AFB OH 45433
U.S.A.
1
The views expressed in this presentation are those of the author and do not reflect the official
policy or position of the United States Air Force, Department of Defense, or the U.S. Government.
Overview
• Range between you and the foghorn (we’ll call it foghorn #1) is
990m
Foghorn
1
Foghorn
2
Potential positions
5m
49
Foghorn
2
You are here!
John F. Raquet, 2012 7
Foghorn
1
Foghorn Foghorn
1 2
• You receive a signal from the second foghorn at
12:00:09
• What can you tell about where you are at this point?
x = 660 m
John F. Raquet, 2012 11
Receiver Clock Errors
Extending to Three Dimensions
R 1' = (x − x1 )2 + (y − y1 )2 + (z − z1 )2 + cδ t
R '2 = (x − x 2 )2 + (y − y 2 )2 + (z − z 2 )2 + cδ t
R 3' = (x − x 3 )2 + (y − y 3 )2 + (z − z 3 )2 + cδ t
R '4 = (x − x 4 )2 + (y − y 4 )2 + (z − z 4 )2 + cδ t
Overview
Kaplan (ed.), Understanding GPS: Principles and Applications, Artech House, 1996
δ tsv δ trcvr
δ tsv δ trcvr
Δ t + δ trcvr - δ tsv
Doppler Shift
• For electromagnetic waves (which travel at the speed of light), the
received frequency fR is approximated using the standard Doppler
equation ⎛ (v r ⋅ a ) ⎞
f R = f T ⎜1 − ⎟
⎝ c ⎠
f R = received frequency (Hz)
fT = transmitte d frequency (Hz)
v r = satellite - to - user relative velocity vector (m/s)
a = unit vector pointing along
line - of - sight from user to SV
c = speed of light (m/s)
– Note that vr is the (vector) velocity difference
v r = v − u
v = velocity vector for satellite (m/s)
u = velocity vector for user (m/s)
• The Doppler shift Δ f is then
Δf = f R − fT (Hz)
Doppler Measurement
• The GPS receiver locks onto the carrier of the GPS signal and
measures the received signal frequency
– Relationship between true and measured received signal
frequency: f R
f R = f Rmeas (1 + δtrcvr )
meas
Δf meas = f Rmeas − f T
Arbitrary,
unknown
point
φmeas (0)
φinteger (t0 )
(integer
ambiguity)
φ(t0 )
Arbitrary,
unknown
point
φ(t0 )
1
∫ Δf meas (t )dt
to
Arbitrary,
unknown
point
φinteger (t0 )
(integer
φmeas (2)
ambiguity)
φ(t0 )
2
∫ Δf meas (t )dt
to
Ignoring clock and other errors
Pseudorange Carrier-Phase
Type of measurement Range (absolute) Range (ambiguous)
Less robust
Robustness More robust
(cycle slips possible)
Necessary for
high precision
GPS
John F. Raquet, 2012 25
Overview
Coordinate Frames
Y
X
John F. Raquet, 2012 29
Geodetic Coordinate Frame
(WGS-84 Ellipsoid)
• There are different ways to describe height (or
altitude)
– Distance above the surface of the earth
– Definition based on gravity
• Geoid: surface of constant gravitational potential
• Geoid is a function of topography, earth density variations, and earth
rotation rate
• Geodesy: study of the geoid
– Definition based upon geometry
• The geoid can be fit to an
ellipsoid (a rotated ellipse)
• One particular ellipsoidal fit b
of the geoid is called the
a
WGS-84 ellipsoid
Equatorial Plane
Geoid Separation
40 40
60 20
80 0
100 -20
120 -40
Negative -60
140
Separation -80
160
-100
180
0 50 100 150 200 250 300 350
John F. Raquet, 2012 31
• Definition of longitude λ
(view from above the
north pole) λ Greenwich Meridian
(0 degrees longitude)
John F. Raquet, 2012 33
Overview
Perigee
b = a 2 (1 − e2 ) t=τ
a
Earth at
focal point
E ν
Earth at
focal point
John F. Raquet, 2012 39
Relationship Between True, Eccentric, and Mean
Anomaly (2/2)
• Correction Terms
i = Rate of change of inclination (rad/sec)
Ω = Rate of change of Ω (rad/sec)
Δn = Mean motion correction (rad/sec)
Cuc , Cus = Argument of latitude correction coefficien ts
Crc , Crs = Orbital radius correction coefficien ts
Cic , Cis = Inclination correction coefficien ts
John F. Raquet, 2012 43
(continued)
For informational
purposes only—not
needed in calculations
Use four-quadrant
arctan function
(“atan2” in MATLAB)
For informational
purposes only—not
needed in calculations
(continued)
John F. Raquet, 2012 49
E0 = M + e sin M
e(sin E j − E j cos E j ) + M
E j +1 =
1 − e cos E j
– RCVR-3A performs two iterations (i.e., stops calculating at E2)
– Don’t confuse these subscripts with subscripts in ephemeris
equations!
xt
γ
xr
• Methodology: yr
– Solve for position of SV at yt
transmit time, in ECEF
coordinates at transmit time (xt, yt, ⎡ xr ⎤ ⎡ cos γ sin γ 0⎤ ⎡ xt ⎤
⎢ y ⎥ = ⎢− sin γ cos γ 0⎥⎥ ⎢⎢ yt ⎥⎥
and zt) using ICD-GPS-200 ⎢ r⎥ ⎢
equations ⎣⎢ zr ⎦⎥ ⎣⎢ 0 0 1⎦⎥ ⎣⎢ zt ⎦⎥
– Rotate into ECEF reference frame t
at the time of reception: γ=Ω e prop
Overview
Pseudorange Equation
• The pseudorange is the sum of the true range plus the receiver
clock error
– We’re assuming (for now) that the receiver clock error is the only
remaining error
• SV clock error has been corrected for
• All other errors are deemed negligible (or have been corrected)
ρj = (x j − xu ) + ( y j − yu ) + (z j − zu ) + cδ tu
2 2 2
= f ( xu , yu , zu , δ tu )
2
– To linearize, we set tˆ = 2 and neglect higher order (non-linear)
terms of Δt
• Valid for perturbations (i.e., small values of Δt)
df d2 f
f (tˆ + Δt ) tˆ = 2 = f (tˆ = 2) + Δt + -10
dt tˆ = 2 2! dt 2 tˆ = 2
-40
-50
1 1.5 2 2.5 3
t
• First order Taylor series for function in two variables:
∂f ∂f
f (aˆ + Δa, bˆ + Δb) = f (aˆ , bˆ) + Δa + Δb + h.o.t.
∂a aˆ ,bˆ ∂b aˆ ,bˆ
John F. Raquet, 2012 59
xu = xˆ u + Δxu
x j − xˆu y − yˆu z − zˆ
ρ j = ρˆ j − Δxu − j Δyu − j u Δzu + Δcδ tu
rˆj rˆj rˆj
⎡ Δρ1 ⎤ ⎡ a x1 a y1 a z1 − 1⎤
⎢a ⎡ Δxu ⎤
⎢Δρ ⎥
⎢ x2 ay2 az 2 − 1⎥⎥ ⎢ Δy ⎥
⎢ 2⎥
Δρ = ⎢ Δρ 3 ⎥ H = ⎢ax3 ay3 az 3 − 1⎥ Δx = ⎢ u ⎥
⎢ ⎥ ⎢ ⎥ ⎢ Δzu ⎥
⎢ ⎥ ⎢ ⎥ ⎢ ⎥
⎢⎣Δρ n ⎥⎦ ⎢ a xn a yn a zn − 1⎥⎦ ⎣Δcδ tu ⎦
⎣
• Three possible cases
– n < 4: Underdetermined case
• Cannot solve for Δx
• Is there still useable information?
– n = 4: Uniquely determined case
• One valid solution for Δx (generally)
• Solved by calculating H-1 (Δx = H-1Δρ ρ)
– n > 4: Overdetermined case
• No solution that perfectly solves equation (generally)
• Can use least-squares techniques (which pick solution that minimizes the square of the error)
John F. Raquet, 2012 65
Solving the Linearized Pseudorange Equations
Using Least-Squares (2/2)
(
Δx = HT C−ρ1H HT C−ρ1Δρ )
−1
Measurement Residuals
v = Δρ − HΔx
Δρ = HΔx + v
John F. Raquet, 2012 67
Δ t + δ trcvr - δ tsv
same as Δt sv from
the previous slide
500
3900 m/s
(
1The SV clock error δ tsv will have a significant effect on the actual pseudorange measurement. This
page only describes the impact of δ tsv on determining the position of the satellite.
John F. Raquet, 2012 71
Use of Dual Frequency Measurements to Calculate
Ionospheric Delay
Calculate approximate
SV clock errors
Calculate Δx
(no relativity correction)
Calculate
Calculate xˆ une w = xˆ uold + Δx
transmit times
Usex̂ u ne w
Calculate SV position Is
and sv clock errors
| Δx | small no
(<10m)?
Correct pseudoranges
for SV clock error* yes
x̂ u ne w is final solution
Stop
*include group delay correction, if a single-frequency user
[ ]
Initial guess of position
Initial clock error
(in error by ~50 km)
expressed in m
– Measurements:
John F. Raquet, 2012 75
Calculate approximate
SV clock errors (Receive time = 220937)
(no relativity correction)
Calculate
transmit times
Calculate SV position
and sv clock errors
Correct pseudoranges
for SV clock error*
PR
Tu + δ trcvr − − δ t = Ts
c sv
receive time
Calculate
transmit times Orbital calculations
+ time-of-transit
Calculate SV position rotation correction
and sv clock errors Δtsv = a f0 + a f1 (t − t0c ) + a f2 (t − t0c )2 + Δtr
Correct pseudoranges
for SV clock error*
ρcorr = ρ + c ( Δtsv − TGD )
*include group delay correction, if a single-frequency user
John F. Raquet, 2012 77
Calculate H, Δρ
Calculate Δx
H=
Calculate
xˆ une w = xˆ uold + Δx
Is
| Δx | small
(<10m)? 0.6
0.4
yes 0.2
ECEF Z
0
x̂ u ne w is final solution -0.2
-0.4
0.5
-0.2 0
Stop -0.4
-0.6 -0.5
-0.8 ECEF X
ECEF Y
Example: Δρ (Iteration 1)
yes
x̂ u ne w is final solution
Stop
John F. Raquet, 2012 79
Calculate H, Δρ
(
Δx = HT H HT Δρ ) −1
xˆ une w = xˆ uold + Δx
Calculate Δx
xˆ unew xˆ uold Δx
Calculate
xˆ une w = xˆ uold + Δx
Is
| Δx | small Residuals: v = Δρ − HΔx
(<10m)?
v Δρρ HΔx
yes
x̂ u ne w is final solution
Stop
0.6 0.6
0.4 0.4
0.2 0.2
ECEF Z
ECEF Z
0 0
-0.2 -0.2
-0.4 -0.4
0.5 0.5
-0.2 0 -0.2 0
-0.4 -0.4
-0.6 -0.5 -0.6 -0.5
-0.8 ECEF X -0.8 ECEF X
ECEF Y ECEF Y
John F. Raquet, 2012 81
Δρ = ρˆ − ρ corr Δρ = ρˆ − ρ corr
T
Iteration 1 Δx = H H ( )
−1
HT Δρ T
Iteration 2 Δx = H H ( )−1
HT Δρ
xˆ une w = xˆ uold + Δx xˆ une w = xˆ uold + Δx
xˆ unew xˆ uold Δx xˆ unew xˆ uold Δx
0.6 0.6
0.4 0.4
0.2 0.2
ECEF Z
ECEF Z
0 0
-0.2 -0.2
-0.4 -0.4
0.5 0.5
-0.2 0 -0.2 0
-0.4 -0.4
-0.6 -0.5 -0.6 -0.5
-0.8 ECEF X -0.8 ECEF X
ECEF Y ECEF Y
Δρ = ρˆ − ρ corr Δρ = ρˆ − ρ corr
John F. Raquet, 2012 85
T
Iteration 2 Δx = H H ( )−1
HT Δρ T
Iteration 3 Δx = H H ( )−1
HT Δρ
xˆ une w = xˆ uold + Δx xˆ une w = xˆ uold + Δx
xˆ unew xˆ uold Δx xˆ unew xˆ uold Δx
Convergence
Overview
• Definition of Cx ⎡ σ 2x σx σx σ x δt ⎤
u yu u zu
⎢ u u u
⎥
⎢σx y σ 2yu σy σ y δt ⎥
u zu
Cx = ⎢ u u u u
⎥
⎢ σ xu zu σy σ 2zu σ z δt ⎥
u zu u u
⎢σ σy σz σ δ2tu ⎥⎥
⎣⎢ xu δtu u δt u u δt u ⎦
where, for example,
[
σ 2xu = E (xu − E[ xu ])
2
]
= variance of xu
σ xu yu = E [(xu − E[ xu ])( yu − E[ yu ])]
= covariance of xu and yu
– Basic assumptions
• Measurement errors are zero-mean
• Measurement errors have a Gaussian distribution
• Recall that the least-squares solution with measurement
weighting was
(
Δx = H T Cρ−1H )−1
H T Cρ−1Δρ
= C x H T Cρ−1Δρ
– Consider case where the nominal position and clock error (used to
calculate Δρ
ρ) are actually the true position and clock error
• The Δρ
ρ represents the measurement errors
• The Δx represents the position and clock errors
• The Cx matrix is a multiplier for the measurement errors (Δρ
ρ)
– “Large” Cx values → large position errors
– “Small” Cx values → small position errors
σ ρ2 = σ ρ2 = ... = σ ρ2 = σ ρ2
1 2 n
σ ρ ρ = 0,
j k
j≠k
– Using these assumptions
Cρ = Iσ ρ2
and
(
Cx = HT H σ ρ2 ) −1
⎢ σ eu σ nu σ u2 σ uδ t ⎥
⎢ u
⎥
⎣⎢σ eδ tu σ nδ t
u
σ uδ t
u
σ δ2tu ⎦⎥
– This is what we desire to describe using DOPs
John F. Raquet, 2012 95
DOP Values
Types of DOPs
σ u2 = VDOP × σ UERE
σ e2 + σ n2 = HDOP × σ UERE
John F. Raquet, 2012 97
Dayton Ohio – 24 Apr 2003 – All Visible SVs (above 10° elevation)