Beruflich Dokumente
Kultur Dokumente
Measurements
May 2006
Precise Velocity Estimation from GPS Measurements
Abstract
Abstract of dissertation entitled:
A lot of research has been conducted on the feasibility of using GPS as a vehicle velocity
meter. In particular, the precision of velocity is one of the interests. In this paper, there
would be different kinds of velocity measurement techniques to evaluate the precision of
GPS velocity. Investigation was performed on comparing and analyzing different
velocities obtained so as to discover the best solution for deriving velocity and the
suggestions for maximizing the performance of GPS.
The project was performed in static and kinematic environments using both the carrier
phase derived Doppler and raw receiver Doppler methods to collect the velocity raw data.
Different environments for velocity measurement such as multipath and high dynamics
were assessed.
2
Precise Velocity Estimation from GPS Measurements
Acknowledgements
I am also grateful to thank Mr. Sydney Cheng, teaching assistant in the department of
Land Surveying and Geo-Informatics, for his useful opinions and guidance on my field
works as well as data analysis.
Moreover, I would like to thank my classmate CHENG Shui Lun, TAI Po Lok, Yu Tsz
Kin for their assistance in the field work with me so that my burden is greatly reduced.
3
Precise Velocity Estimation from GPS Measurements
Contents
ABSTRACT……………………………………………………………...…………….. i
ABKNOWLEDGEMENT…………………………………………………………... ii
CONTENTS…….…………………………………………………………………..… iii
LIST OF FIGURES………………………………………………………………….. iv
LIST OF TABLES…………………………………………………………………..... v
CHAPTER 1 INTRODUCTION
1.1 Background………………………………………………………………..... 1
1.2 Objectives…………………………………………………………….……... 1
CHAPTER 3 METHODOLOGY
3.1 Observations Modes for GPS Velocity……………………………………..
3.1.1 Static Observation ………………………………...………..……….
3.1.2 Kinematic Observation……………...………………………………
3.1.3 GPS Velocity Accuracy Assessment….…………………………….
3.2 Data Output………….………………………………………………………...
4
Precise Velocity Estimation from GPS Measurements
REFERENCE…………………………………………………………………………
5
Precise Velocity Estimation from GPS Measurements
List of Figures
Figure 2.2.1 Doppler’s Effect………..……………………………………………………
6
Precise Velocity Estimation from GPS Measurements
List of Tables
Table 3.2.1 VTG Sentence Output from Leica GPS System 500……………………….
Table 3.2.2 VTG Sentence Output from Trimble DSM 212H………………………….
Table 5.1.1 Statistical Result Showing the Static Observation Result…………………
Table 5.2.1 Position Shifts Generated from Velocity and Pseudorange Position Data.
Table 5.2.2 Difference between RTK and GPS Velocity (North and East) in Three
Trials (Mean and Standard Deviation of Total Time Elapsed)………………………...
7
Precise Velocity Estimation from GPS Measurements
Chapter 1: Introduction
1.1 Background
Traditionally, measuring velocity can be done externally by speedometers. Nowadays,
with the growing popularity and accuracy of the Global Positioning System (GPS), GPS
is becoming one of the possible solutions to determine velocity with an accuracy of a few
meters depending on the specification and methods. In this case, a number of researches
have been done to achieve a cheaper and more accurate velocity measurement using GPS
by adopting specific approaches and controls.
To determine more precise GPS velocity, the Doppler’s frequency shift measurement is
one of the approaches. This approach has been researched for a few years and their
results appear that the development should attain a desirable accuracy in the future. In
this situation, the GPS will soon be a major solution in precise velocity determination.
1.2 Objectives
Apart from the trend of GPS velocity development, some interests are drawn on the
accuracy of the velocity and its ability of accuracy achievement in stand-alone mode.
Therefore, I would emphasize on two main ways of position determination, pseudorange
and carrier phase position, to find the velocity with computation of time. Furthermore,
based on velocity accuracy achieved, the accuracy position output from pseudorange
should be raised by the adjusting with velocity.
8
Precise Velocity Estimation from GPS Measurements
λ1 λ2
When a satellite transmits signal (in wave) to the receiver, the signal will be received on
the ground receiver with a change in frequency and wavelength since both the receiver
9
Precise Velocity Estimation from GPS Measurements
and satellite are in motion. This small change in frequency is the Doppler’s shift and the
GPS receiver has to continually track it to determine the velocity.
The basic equation for Doppler’s shift is as follow:
V
Fd = Fs
C
where,
Fd is the Doppler shift frequency
Fs is source frequency
V is the relative speed between source and observer
C is the speed of sound
Many reviews on achieving precise GPS velocity measurements usually adopt the
Doppler’s shift frequency to determine a more stable and smooth velocity.
The Doppler’s shift can not be measured directly by a single receiver. The velocity is
derived by the Kalman filter inside the GPS receiver.
The noise from receiver generated Doppler is usually larger than the carrier phase derived
Doppler since the measurement time for receiver generated one is short. On the other
hand, the carrier phase derived Doppler provides a smooth velocity output with a long
period of measurement between observation epochs and the noise is much lesser. By
differencing carrier phase observation equation, the carrier phase derived Doppler can be
computed.
10
Precise Velocity Estimation from GPS Measurements
The frequency of carrier on receiver is constant while the received carrier frequency is
changing because of the Doppler’s shift by the relative motion between the satellite and
receiver. The phases for receiver and satellite are related by the time elapsed for the
signal to transmit from the satellite to the receiver. The carrier phase measurement is then
the integral number of carrier cycles plus the fractional cycles. However, GPS receiver
has no ability to determine the integer number of cycles and therefore the initial number
of cycles becomes ambiguous. The GPS receiver will assume the number of cycles
arbitrary when it first locks on the satellite. To solve the integer ambiguity N, the
coordinates of the receiver are required.
receiver, c is the speed of light, dt-dT are the GPS time offsets of satellite and receiver
clocks, λ is the wavelength of carrier. dion and dtrop are the ionospheric and tropospheric
The above equation can be transferred as the observation equation for velocity
determination. Serrano et al[2004] demonstrated the algorithm as below:
us = hus ⋅ (v u − V s ) + B u − ε us
Φ Φ
where us is the velocity, hus is the directional cosine vector between the receiver and
Φ
satellite, v u is the receiver velocity vector, V s is the satellite velocity vector, B u is the
11
Precise Velocity Estimation from GPS Measurements
the satellite clock drift, I us is the ionospheric delay rate, Tus is the tropospheric delay
∂V is the error in satellite velocity derivation and ξ is the receiver system noise.)
S
rate,
εs
The components inside u were modeled out as random errors and the remaining
Φ
parameters became unknowns. The satellite velocities and satellites clock drift can be
estimated from Earth-Centered-Earth-Fixed (ECEF) satellite coordinates from broadcast
ephemerides by differencing epoch-by-epoch satellite positions. Each epoch of velocity
solution can be achieved.
The first order central difference approximation of the carrier phase to generate the
Doppler measurements was demonstrated by Cannon and Szarmes et al [1997]. They
performed experiments on finding velocity errors with two types of receivers using the
raw Doppler measurement from the receivers and carrier phase-derived Doppler
measurements by the first order central difference approximation in both static, low
dynamics and high dynamics. The advantage of it is the easy implementation and
provision of appropriate velocity estimates in low dynamics environments. The velocity
errors are minimized a lot after applying the approximation.
Two processes are modeled by a Kalman filter [NAVSTAR GPS USER EQUIPMENT
INTRODUCTION, 1996]. The first model is the system dynamics model and describes
how the error state vector changes in time. The second model is the measurement model
and describes the relationship between the error state vector and any measurements
12
Precise Velocity Estimation from GPS Measurements
processed by the filter. The principle of the Kalman filter is to determine the accuracy of
measurements and apply larger weighing to those measurements which are accurate and
reversely smaller for inaccurate measurements.
The system dynamics process continuously tracks the error state vector of the total
navigation state. The total navigation state can be defined as the mean position and
velocity in accordance with different applications. The system can predict the error state
vector for next epoch. At particular time t, the error in the estimated total navigation state
is x(t) with y(t) denotes the navigation state and ŷ(t) its estimate. x(t)= ŷ(t)-y(t).
This differential equation is non-linear and expanded in a Taylor’s series. Then the
equation is differenced with the true state and higher order terms are eliminated. At
discrete time tk, the linear differential equation for the time rate of change of the
navigation error state is:
x(tk)=Фk-1x(tk-1)+Gk-1(tk-1)w(tk-1)
where Gk-1 is the state transition matrix which indicates the change of error state vector
with time
w(tk-1) is the white, zero mean Gaussian noise sequence
The measurement process is to relate the error state vector with measurements provided
by other sensors. Forming the measurement equation is similar to system dynamic
process. The non-linear total navigation state differential equation is expanded and the
higher order forms are ignored. The equation at particular time tk is:
z(tk)=Hkx(tk)+v(tk)
where z(tk) is the measurement at time tk
Hk is the measurement matrix
v(tk) is the white, zero mean Gaussian sequence.
13
Precise Velocity Estimation from GPS Measurements
performed for 30 to 45 minutes of rate of 1 Hz [Szarmes et al]. The purpose of the static
measurement is to derive how the GPS velocity agrees with the zero velocity and thus
determine the velocity estimates as well as the precision and errors.
The second part is the kinematic observation. The first procedure of all is the static
initialization. For kinematic measurement, it is required to stay on a platform for about 15
minutes for static initialization to derive GPS velocity performance under the real
situation. After static initialization, the GPS receiver is moved along the predetermined
path from the starting point to the ending point. The visibility to the sky is essential. The
receiver should be moved at constant velocity according to different demands of the
measurement procedure.
The result produced by Szarmes et al [1997] indicated the performance of two types of
receivers. In terms of static test, the result shows a millimeter deviation of 3D velocity
errors for two receivers. In aircraft static initialization, there are a number of approaches
to assess the measurements. With [a] raw Doppler measurements of two receivers, [b] the
first order central difference approximation of carrier phase measurement for one
particular receiver and [c] the two receiver raw Doppler measurements differenced with
the previous carrier phase derived Doppler velocities, the tests try to find the best solution
for velocity estimates for two receivers and the result of one receiver is prior to another
one. The kinematic test adopts the approach [c] in the static initialization to assess the
accuracy in velocity. It shows a very small increase in velocity error from static to
kinematic.
14
Precise Velocity Estimation from GPS Measurements
15
Precise Velocity Estimation from GPS Measurements
Chapter 3 Methodology
16
Precise Velocity Estimation from GPS Measurements
Pseudorange approach
Pseudorange is the collection of horizontal position data through $GPLLK of NMEA
0183 message output. This message provides pseudorange local grid coordinates data.
These data are collected to determine the position changes and thus determine the
velocity in kinematic observation. The data are adjusted together with the position data
processed by GPS velocity and time using Kalman filter.
17
Precise Velocity Estimation from GPS Measurements
Asterisk Delimiter
Comma Delimiter
$GPVTG,153.5313,T,153.5313,M,0.011,N,0.021,K,A*33
Message
Identifier
Field 1
Field 2 Checksum
Field 3 Field 9
Field 4 Field 8
Field 5 Field 7
Field 6
Two GPS systems, Leica GPS system 500(SR 530) and Trimble DSM 212H are assessed
and they respectively provide slightly different NMEA messages of velocity outputs.
They both adopt message identifier VTG as velocity message output and provide nearly
the same VTG format. However, the Trimble GPS is mainly used for marine application
and it uses “track over ground” as the direction from true north. The Leica GPS is used
mainly in land application and the velocity information output is “course over ground”.
The speed output has two kinds of units: knots and km/hr with 3 decimal places. 1 Knot
is equal to 1.8532 km/hr.
18
Precise Velocity Estimation from GPS Measurements
19
Precise Velocity Estimation from GPS Measurements
For kinematic observation, I choose Ho Man Tin for field measurement. This place
provides adequate visibility for GPS. This area is a football court with good sky visibility
and thus providing a desirable situation for GPS. The area is also plain and large enough
for field works.
20
Precise Velocity Estimation from GPS Measurements
Before GPS field work, it is necessary to calibrate the GPS for static and kinematic
modes. The update rate is set to 5 seconds for static and 1 second for kinematic. Faster
observation rate would be required for kinematic mode to obtain faster data change in
21
Precise Velocity Estimation from GPS Measurements
There is quite a large variation of velocity when the receiver starts to operate. Therefore,
the receiver is stayed for some times to wait for a more static performance of velocity
output. The data will be collected until they become stable. It is necessary to convert the
unit (km/hr) into unit (m/s) for post-processed interpretation.
The resulting velocity vector will then be resolved into two horizontal velocity vectors by
the course angle from true north (Ө).
vx = v cosӨ N
vy = v sinӨ
Ө
vy E
vx
22
Precise Velocity Estimation from GPS Measurements
25 m
A route of approximate 100 meters with each side equals to 25 meters is set up by a steel
tape. A GPS receiver is stayed on the starting point for 15 minutes to determine the
coordinates (xo, yo) and perform initialization. Then the receiver is moved manually along
the route as shown above from the starting point and the starting time is recorded. It
travels along a square path and ends at the starting point. The receiver will be put back on
the tripod to attain the same ending position and the ending time is recorded. The test is
performed for three times to assess and compare the accuracy of three tests. The
advantage of a square path is its easy route design. The receiver should be held as vertical
as possible during movement to minimize errors such as cycle clips. The update rate of
data is fixed at 1 second interval.
The principle behind the experiment is to discover the velocity performance for stand-
alone GPS in kinematic environment.
The formula below explains the phenomenon:
x = xo + vxΔt
23
Precise Velocity Estimation from GPS Measurements
y = yo + vyΔt
where xo and yo are the initial coordinates, x and y are the coordinates of the next epoch.
Δt is the time elapsed, vx is the easting velocity vector and vy is the northing velocity
vector.
The coordinates of the next location can be computed by using the velocity data and time.
The relevant data are loaded from the LLK, VTG and GGA messages. The position of
next epoch is computed by using the formula above. After running up the whole path and
coming back to the starting point, the pseudorange position calculated from the GPS
velocity and time as well as the position of the initial coordinates can be compared.
There are three attempts in the experiment. It is necessary to collect three sets of data and
to compare their respective accuracy. Some interpretations are focused on the
pseudorange and carrier phase observation. Pseudorange observation is equal to the
difference between the receiver time tr and satellite time tk at signal transmission
24
Precise Velocity Estimation from GPS Measurements
Velocity (North)
(m/s) 0 500 1000 1500 2000 2500 3000
0
-0.001
-0.002
-0.003
-0.004
-0.005
-0.006
Clips Time Elapsed (second)
0.003
0.0025
0.002
0.0015
0.001
0.0005
0
0 500 1000 1500 2000 2500 3000
Time elapsed (second)
25
Precise Velocity Estimation from GPS Measurements
It can be seen from the above graphs that the velocities for north and east vectors are not
real “zero” and there are some errors for the GPS receiver. The velocity output is around
5 millimeters per second for northing vector and 1.75 to 3 millimeters per second for
easting vector. The velocity error is quite small for both velocity vectors. The variation is
not large for northing vector and less than 2 millimeters per second for easting vector.
This small variation indicates the small static velocity errors.
The table below shows the data collected during the beginning. It shows the variation of
velocity is quite high and there are some outliers.
Large velocity variation
during the start of survey
Outlier
26
Precise Velocity Estimation from GPS Measurements
27
Precise Velocity Estimation from GPS Measurements
0
-30 -25 -20 -15 -10 -5 0 5 Start
& End
-5
-10
y (m)
-15
-20
-25
-30
x (m)
Figure 5.2.2 Position Variation along a 100m Track using Velocity Data (Trial 1)
819050
819045
Start
& End
Northing (m)
819040
819035
819030
819025
819020
836685 836690 836695 836700 836705 836710 836715 836720 836725
Easting (m)
28
Precise Velocity Estimation from GPS Measurements
0
-30 -25 -20 -15 -10 -5 0 5 Start
-5
& End
-10
y (m)
-15
-20
-25
-30
x (m)
Figure 5.2.4 Position Variation along a 100m Track using Velocity Data (Trial 2)
819050
Start
819045
Grid Northing
819040
819035
819030
819025
819020
836685 836690 836695 836700 836705 836710 836715 836720 836725
Grid Easting
29
Precise Velocity Estimation from GPS Measurements
0
-30 -25 -20 -15 -10 -5 0 5 Start
& End
-5
-10
y (m)
-15
-20
-25
-30
x (m)
Figure 5.2.6 Position Variation along a 100m Track using Velocity Data (Trial 3)
819050 Start
& End
819045
Grid Northing
819040
819035
819030
819025
819020
836685 836690 836695 836700 836705 836710 836715 836720 836725
Grid Easting
30
Precise Velocity Estimation from GPS Measurements
1
Velocity North (m/s)
0.5
0
15:33:24 15:33:42 15:33:59 15:34:16 15:34:34 15:34:51 15:35:08 15:35:25 15:35:43 15:36:00 15:36:17
-0.5
-1
-1.5
Time elapsed(hh:mm:ss)
1
Velocity East (m/s)
0.5
0
15:33:24 15:33:42 15:33:59 15:34:16 15:34:34 15:34:51 15:35:08 15:35:25 15:35:43 15:36:00 15:36:17
-0.5
-1
-1.5
Time elapsed(hh:mm:ss)
31
Precise Velocity Estimation from GPS Measurements
Assuming the starting point starts at (0, 0), the velocity and time data are processed
together to generate the relative position variation along the track. At the same time, the
pseudorange position data are also recorded. After processing out three sets of data in two
approaches, we find out the shifts in easting and northing and compare their error values
for these two approaches.
The main interpretation should focus on the starting and ending position.
In the above three trials, the shift in velocity generated position data are in reasonable
amount which is not larger than 0.5 meters.
The pseudorange position data are erroneous with unexpected large errors in trials 2 and
3. The position shifts are very large in compare with trial 1.
When comparing the velocity generated position data with pseudorange position data,
there are obviously large differences. The main cause is due to the large errors in
pseudorange position data. Trial 1 has the least difference compared with other two trials.
Another thing is examined is the pattern of two methods of position outputs. The velocity
32
Precise Velocity Estimation from GPS Measurements
generated position has a nearly square pattern along the whole track. However, the
pseudorange position pattern is not in a “square” pattern. The error generated should be
composed of both random errors and less accurate position performance.
Based on the above information, both the pseudorange and velocity data should contain
errors but pseudorange would have larger errors.
The shifts in the three trials are larger and more unexpected for pseudorange data since
stand-alone pseudorange positions usually have large errors in meters level.
After each trial, the receiver is put back to the tripod. The static position keeps changing
since the velocity is not absolutely zero. However, the position does not really shift after
the receiver stops and the static velocity implies the velocity error generated by the
receiver as it is not zero.
0.08
0.06
0.04
0.02
0
-0.02 0 5 10 15 20 25 30
Time (second)
Figure 5.2.10 Velocity North Changes after Running up the Whole Path (Trial 1)
0
-0.02 0 5 10 15 20 25 30
-0.04
-0.06
-0.08
Time (second)
33
Precise Velocity Estimation from GPS Measurements
Figure 5.2.11 Velocity East Changes after Running up the Whole Path (Trial 1)
2
1.5
Velocity North (m/s)
1
0.5
0
15:33:07
-0.5 15:33:50 15:34:34 15:35:17 15:36:00 15:36:43
-1
-1.5
-2
Time (hh:mm:ss)
1
Velocity East (m/s)
0
15:33:07 15:33:50 15:34:34 15:35:17 15:36:00 15:36:43
-1
-2
-3
-4
Time (hh:mm:ss)
34
Precise Velocity Estimation from GPS Measurements
Observation equation
x k = x E + n3
y k = y N + n4
where xk, yk are the pseudorange easting and northing
n3 and n4 are the errors.
We can see the relationship from the above two sets of equations. The position derived
from the velocity should have the same position derived from pseudorange if there are no
errors. As the field works done, we assume the initial position (xEo, yEo) as (0, 0) and
generate the position solution at next epoch by GPS velocity and time. The velocity
generated position difference should have similar position difference that provided by
pseudorange. Time is set at 1 second interval and the receiver time is modeled out as
random error. Therefore, the remaining components pseudorange position and velocity
are combined together and adjusted by Kalman filter.
There are four components pseudorange easting (xk), northing (yk) and velocity easting
(vx), northing (vy) to be adjusted.
35
Precise Velocity Estimation from GPS Measurements
xk n1
y n
The state vector is then created as x ( k ) = k
and v k =
2
V x n3
V y n4
Observation model
The observation model includes the measurement and state vector. The equations are as
follow: At particular epoch k, the estimated state vector equals to x(k).
By using least square adjustment, the observation at time = tk will become
xk
y
y( k ) = A( k ) x ( k ) + V ( k ) where y( k ) = and A( k ) = I
k
V x
V y
where A(k) is the design matrix, x(k) is the state vector matrix, y(k) is the matrix of
observation and V(k) is the error vector of observation matrix
Dynamic model
The dynamic model shows the relationship of two state vectors between the two different
epochs. In this model, the state vector at time t = k-1 is used to relate the observation at
time t = k by transition matrix
where Δt = 1 second.
x ( k ) = Φ( k , k − 1) x ( k − 1) + U ( k )
where x(k-1), x(k) are state vectors at epochs k-1 and k, U(k) is the error vector of state
vector matrix and Φ(k,k-1) is the transition matrix and
1 0 ∆t 0 1 0 1 0
0 1 0 ∆t 0 1 0 1
Φ( k , k − 1) = =
0 0 1 0 0 0 1 0
0 0 0 1 0 0 0 1
The first procedure of Kalman filter is the prediction model. The estimated state vector
between two adjacent epochs x ( k , k − 1) is computed from the estimated state vector in
36
Precise Velocity Estimation from GPS Measurements
37
Precise Velocity Estimation from GPS Measurements
Prediction
The prediction model is as follow:
x ( k , k − 1) = Φ( k , k − 1) x ( k − 1, k − 1)
P ( k , k − 1) = Φ( k , k − 1) P ( k − 1, k − 1)Φ( k , k − 1) + Q
where P ( k , k − 1) and P ( k − 1, k − 1) are the predicted covariance matrices of the
estimated state vector x ( k , k − 1) and x ( k − 1, k − 1)
Q is the covariance matrix of error vectors U(k)
Estimation
[
K ( k ) = P ( k , k − 1) AT ( k ) A( k ) P ( k , k − 1) AT ( k ) + R( k ) ] −1
x ( k , k ) = x ( k , k − 1) + K ( k )[ y( k ) − A( k ) x( k , k − 1)]
P ( k , k ) = [ I − K ( k ) A( k )] P ( k , k − 1)
where K(k)is the gain matrix
x(k,k)is the state vector at epoch k using prediction model
P(k,k)is the covariance matrix of state vector at epoch k using prediction model
R(k) is the covariance matrix of error vectors V(k)
38
Precise Velocity Estimation from GPS Measurements
in Q matrix are varied. The variation is based on the accuracy of the observation data that
should be achieved and the values should start from small values and enlarge it until the
pattern match best with the data in velocity-derived position (the dynamic model).
819045
0 52 0 0
R=
819040 0 0 0.012 0
0 0 0 0.012
819035
52 0 0 0
819030 0 52 0 0
Q=
0 0 0.012 0
819025 0 0 0 0.012
819020
836685 836690 836695 836700 836705 836710 836715 836720 836725
Adjusted Easting (m)
1000
Adjusted 0
Result
0with P0= 1000, R = 25,25,0.0001,0.0001
0 1000 0 0
Q = 100,100,0.01,0.01
P=
819055
0 0 1000 0
0 0 0 1000
819050
52 0 0 0
Adjusted Northing (m)
819045
0 52 0 0
R= 2
819040 0 0 0.01 0
0 0 0 0.012
819035
10 2 0 0 0
819030 0 10 2 0 0
Q=
0 0 0.12 0
819025 0 0 0 0.12
819020
836685 836690 836695 836700 836705 836710 836715 836720 836725
Adjusted Easting (m)
39
Precise Velocity Estimation from GPS Measurements
0
819045
0 5 2
0 0
R= 2
819040 0 0 0.01 0
0 0 0 0.012
819035
1002 0 0 0
819030 0 100 2
0 0
Q= 2
0 0 1 0
819025 0
0 0 12
819020
836685 836690 836695 836700 836705 836710 836715 836720 836725
Adjusted Easting (m)
The above three graphs tell the position variation after the adjustment by fixing the R
matrix and varying the Q matrix. The graphs above are started from the smallest value
“5m” for position coordinates and “0.01m/s” for velocity inside the Q matrix. The values
are increased as “10m / 0.1m/s” and “100m / 1m/s” for graphs 2 and 3. The result from
the second graph shows the best result among the three and provides the smoothest
solution. It is found that when the values inside the Q matrix increase, the resulting graph
will be more “straight”. The Q matrix is large in compared with the R matrix and the
information is mainly based on the dynamic model (i.e. The velocity-derived position).
The decision of the amount of values inside the Q matrix is based on the resulting graph.
The choice of values inside the Q matrix is that the increment of values should undertake
a significant change in patterns. After several trials, the best change in values with the
pattern would be as above shown.
Now, the next procedure is to perform another test to deduce the values for other R
matrices varying with Q matrix.
40
Precise Velocity Estimation from GPS Measurements
819045
0 10 2
0 0
R= 2
819040 0 0 0.1 0
0 0 0 0.12
819035
10 2 0 0 0
819030 0 10 2 0 0
Q=
0 0 0.12 0
819025 0 0 0 0.12
819020
836685 836690 836695 836700 836705 836710 836715 836720 836725
Adjusted Easting (m)
819045
0 10 2
0 0
R= 2
819040 0 0 0.1 0
0 0 0 0.12
819035
100 2 0 0 0
0 100 2
0 0
819030 Q=
0 0 12 0
819025 0 0 0 12
819020
836685 836690 836695 836700 836705 836710 836715 836720 836725
Adjusted Easting (m)
The two graphs above show the variation based on fixing another R matrix. The approach
is similar to previous set of R matrix. This time the R matrix is larger and the Q matrix is
varied from the smallest value. The smallest value should not be larger than the R matrix
since the receiver ability should not overtake the measurement error. Graph 2 shows
similar pattern as the previous third graph. It illustrates that the dynamic model overtakes
the measurement model. These two graphs do not show a great difference with the
41
Precise Velocity Estimation from GPS Measurements
previous set of graphs and therefore it is needed to adjust the values of P matrix to outline
more suitable solutions. This time the values inside P matrix are increased to “10000” to
see any significant change for the graph.
819045
0 5 2
0 0
R= 2
819040 0 0 0.01 0
0 0 0 0.012
819035
52 0 0 0
819030 0 52 0 0
Q=
0 0 0.012 0
819025 0 0 0 0.012
819020
836685 836690 836695 836700 836705 836710 836715 836720 836725
Adjusted Easting (m)
819045
0 5 2
0 0
R= 2
819040 0 0 0.01 0
0 0 0 0.012
819035
10 2 0 0 0
0 10 2 0 0
819030 Q=
0 0 0.12 0
819025 0 0 0 0.12
819020
836685 836690 836695 836700 836705 836710 836715 836720 836725
Adjusted Easting (m)
42
Precise Velocity Estimation from GPS Measurements
819045
0 5 2
0 0
R= 2
819040 0 0 0.01 0
0 0 0 0.012
819035
100 2 0 0 0
819030 0 100 2
0 0
Q= 2
0 0 1 0
819025 0 0 0 12
819020
836685 836690 836695 836700 836705 836710 836715 836720 836725
Adjusted Easting (m)
From the results above, it is possible to adjust the position from velocity information
under suitable adjustment model, parameters and constraints, etc. The resultant positions
would be smoother, as compared with unadjusted information.
43
Precise Velocity Estimation from GPS Measurements
1
RTK velocity North (m/s)
0.5
0
15:55:26 15:56:10 15:56:53 15:57:36 15:58:19 15:59:02
-0.5
-1
-1.5
elasped time (hh:mm:ss)
1
RTK velocity East (m/s)
0.5
0
15:55:26 15:56:10 15:56:53 15:57:36 15:58:19 15:59:02
-0.5
-1
-1.5
elapsed time (hh:mm:ss)
44
Precise Velocity Estimation from GPS Measurements
1
Velocity North (m/s)
0.5
0
15:55:35 15:57:19 15:59:02
-0.5
-1
-1.5
Time elapsed(hh:mm:ss)
1
Velocity East (m/s)
0.5
0
15:55:35 15:57:19 15:59:02
-0.5
-1
-1.5
Time elapsed(hh:mm:ss)
45
Precise Velocity Estimation from GPS Measurements
From the table above, we can see the differences between RTK and GPS velocity in three
trials are very small. The standard deviation indicates the differences compared between
two velocity determination approaches are not very large.
In compare with the pseudorange position coordinates and RTK carrier phase position
coordinates, the difference is obvious. Their large accuracy difference furthermore
describes good position coordinates are not essential in determining good velocity
solution. GPS velocity should itself provide quite an accurate solution from receiver-
derived Doppler.
46
Precise Velocity Estimation from GPS Measurements
6.3
The planned schedule requires me to do the velocity comparison with vehicles but I can’t
finish the measurement on time. This is good for vehicle planning
Conclusion
Inside the three methods on deriving the velocity, the RTK approach should be the most
accurate but the fact is that it makes a very small amount of difference with the velocities
outputted from the GPS. This difference should also include some errors but they
shouldn’t do a very large amount of disturbance to real values. Pseudorange provides
quite a large data discrepancy but it is quite reasonable since the data accuracy is not
high. Although I haven’t done the carrier phase velocity estimation, the velocity
measurement shouldn’t have larger data errors with that provided by RTK. Since RTK
determined the position based on carrier-phase platform, the
The two with velocity are performed and the result tells that the GPS velocity contains
small extent of errors of around 0.002 to 0.005 m/s. This amount is very small and the
velocity is good enough for velocity determination.
For future development, there should be similar measurements using vehicles for more
realistic environment. The vehicle can provide higher speed and the data can be further
determined. It also provides high dynamic solution (large acceleration).
47
Precise Velocity Estimation from GPS Measurements
Reference
Papers and Reference Books
P.J.G. Teunissen and A. Kleusberg (Eds.) (1998), GPS for Geodesy, Springer-Verlag,
Berlin-Heidelberg-New York; pp. 165-166.
Luis Serrano, Donghyan Kim and Richard B. Langley (2004), A GPS Velocity Sensor:
How Accurate Can It Be? – A First Look, Proceedings of ION NTM 2004 San Diego,
California, 26-28 January, 2004; pp 875-885.
Andrew Simsky and Frank Boon, Carrier Phase & Doppler-based Algorithms for Real-
time Standalone Positioning, Septentrio NV, Belgium
S. Ryan, G Laceapelle and M.E. Cannon (1997), DGPS Kinematc Carrier Phase Signal
Simulation Analysis in the Velocity Domain, Proceedings of ION GPS 1997, Kansas
City, Missouri, September 16-19, 1997.
M. Szarmes, S. Ryan and G Lachapelle (1997), DGPS High Accuracy Aircraft Velocity
Determination Using Doppler Measurements, Proceedings of the International
Symposium on Kinematic Systems (KIS), Banff, AB. Canada, June 3-6, 1997.
Luis Serrano, Don Kim and Richard B. Langley (2004), A Single GPS receiver as a Real-
Time, Accurate Velocity and Acceleration Sensor, Proceedings of ION GNSS 2004,
Long Beach, California, 21-24 September, 2004; pp 2021-2034.
Capt. J. Hebert and J. Keith (1997), DGPS Kinematic Carrier Phase Signal Simulation
Analysis for Precise Aircraft Velocity Determination, Proceedings of the ION Annual
Meeting, Albuquerque, NM, 3 June – 2 July, 1997.
A.M. Bruton, C.L. Giennie and K.P. Schwarz (1999), Differentiation for High-Precision
GPS Velocity and Acceleration Determination, GPS Solutions, Vol.2, No. 4; pp. 7-21
48
Precise Velocity Estimation from GPS Measurements
Appendix E, Leica GPS System 500 Technical Reference Manual Version 4.0 (2002),
Leica Geosystems AG, Heerbrugg, Switzerland, 2002
NMEA 0183 Standard, National Marine Electronics Association
http://www.nmea.org/pub/0183/
49