Professional Documents
Culture Documents
Development of A Low-Cost Solution For GPSGyro Att
Development of A Low-Cost Solution For GPSGyro Att
net/publication/267403272
CITATIONS READS
12 1,115
2 authors, including:
Gérard Lachapelle
The University of Calgary
107 PUBLICATIONS 1,820 CITATIONS
SEE PROFILE
Some of the authors of this publication are also working on these related projects:
All content following this page was uploaded by Gérard Lachapelle on 14 July 2015.
ABSTRACT INTRODUCTION
The use of low cost GPS receivers for attitude GPS-based attitude determination techniques have been
determination can significantly reduce the overall cost of extensively investigated in the last ten years and proven to
a hardware system. However, compared to the use of high be a cost effective solution without errors drifting over
performance GPS hardware, the carrier phase time (e.g. Cohen 1992, Lu 1994). However, most past
measurements from low cost sensors are subject to work has been done using high performance GPS
additional carrier phase measurement errors, such as receivers and antennas so as to mitigate carrier phase
multipath, antenna phase center variation and noise. measurement errors and further improve the accuracy and
These error sources, together with cycle slip occurrences, reliability of attitude determination systems. In recent
severely deteriorate the accuracy and reliability of attitude years, as low cost GPS receivers that can output good
estimation using low cost GPS receivers. quality time-synchronized carrier phase measurements
appeared on the market, some research has been carried
To overcome the limitation of standalone GPS attitude out to investigate the feasibility of using this grade of low
determination systems, an integration solution using low cost GPS hardware for attitude determination so that the
cost GPS receivers and rate gyros is investigated in this overall cost of attitude solution could be reduced to
paper. By employing this dead reckoning aiding sensor several hundreds of dollars [Hoyle et al 2002, Gebre-
type, the ambiguity search region can be specifically Egziabher et al, 1998].
defined as a small cube based on the continuous attitude
and inter-antenna configuration information. An extended GPS carrier phase measurement errors, such as multipath,
centralized Kalman filter is implemented to fuse the rate antenna phase center offsets and receiver noise from low
gyro data with GPS carrier phase measurements. The cost GPS receivers and antennas have a more significant
impact on performance due to the hardware limitations.
Proceedings of NTM 2004 Conference (Session A2), San Diego, CA, January 26-28, 2004, The Institute of Navigation 1/10
Previous research [Hoyle et al 2002, Wang & Lachapelle x, y, z are the cartesian coordinates of antenna vector,
2002] has shown that, even though the low cost Allstar superscript b represents the body frame
sensors can be used for attitude determination, the superscript ll stands for the local level frame.
performance of such a low cost system highly depends on
the multipath environment and platform dynamics. In In this research, an open-architecture attitude
cases with strong multipath and large antenna phase determination software developed at the University of
centre variations, it takes a long time to solve the carrier Calgary, namely HEADRT+TM, is used as the base for
phase integer ambiguities or even wrong ambiguities may algorithm development. The attitude estimation in
be identified during the search process, which inevitably HEADRT+TM is carried out in two phases: The first phase
leads to large erroneous attitude component estimates. determines the correct double difference carrier phase
ambiguities for the antenna vector(s). After coordinate
In order to improve the performance of low-cost attitude transformation from WGS-84 into the local level frame,
determination system, three piezoelectric rate gyros, the attitude parameters are estimated from the quasi-
namely Murata ENV-05D-52 Gyrostar units, are used observable vector components in the second phase.
herein as sensors to monitor the angular rates around the
three axes in the body frame. These automotive rate gyros HEADRT+TM uses the Least Squares Ambiguity Search
are selected for their low cost (about $15 per unit in large Technique (LSAST) (Hatch 1991) to determine the
quantities) and the competitive performance relative to double difference carrier phase ambiguities. Firstly, the
other MEMS gyro sensors with similar prices. The location of the master antenna is determined from a
angular rate measurements are fused with the GPS standard single point position. Since no attitude
antenna vector components to estimate the attitude information is known a priori, the ambiguity search
parameters as well as their angular rates in a Kalman filter. region is defined as a sphere with the origin as the
The improvement resulting from employing these low primary antenna location and the radius of the inter-
cost rate gyros can be classified into three categories, antenna distance. Therefore, the potential position of the
namely accuracy, availability and reliability. The secondary antenna should fall on the shell of this sphere
integration methodologies are realized in a high regardless of the orientation of inter-antenna vectors.
performance, open architecture attitude determination After forming all the double difference ambiguities
software, namely HEADRT+TM [e.g. Hoyle et al 2002]. combinations that fall in the sphere, some statistical tests
The performance of the integrated system is examined based on double difference residuals and the inter-antenna
both under static and kinematic conditions. length check are used to identify the correct ambiguity set
(Hoyle et al 2002).
ATTITUDE DETERMINATION USING GPS Once the inter-antenna vector ambiguities are fixed, the 3-
D vector components are transformed from WGS-84 to
GPS sensors in an attitude system are primarily used to the local level frame. The three Euler attitude parameters
determine the inter-antenna vectors as well as the are calculated using an implicit least squares estimation to
approximate positions of the platform in the navigation allow for the epoch-by-epoch assessment of attitude
frame. Regardless of the platform dynamics, the relative estimates under any dynamics. Kalman filter estimation
positions of the antennas in the body frame remain fixed has also been implemented in the software. The filter is
and can be accurately measured a priori. The attitude of especially effective when the platform dynamic is
the platform, which is the rotation of the body frame with predictable relative to the carrier phase measurement rate.
respect to the local level frame, can then be precisely
estimated once if the coordinates of the antennas in the
local level frame have been correctly estimated by the PERFORMANCE OF LOW-COST GPS SYSTEM
GPS measurements. The three Euler attitude angles in the
rotation matrix can be obtained using the follow equation: After the double differencing process, the clock errors
(both satellite and receiver clocks) have been virtually
⎛ xb ⎞ ⎛ x ll ⎞ cancelled out. The remaining error sources in the double
⎜ b⎟ ⎜ ⎟ difference carrier phase observables are multipath,
⎜ y ⎟ = Rllb (ψ ,θ , ϕ )⎜ y ll ⎟ (1) antenna phase centre variations, cycle slips as well as
⎜ zb ⎟ ⎜ z ll ⎟ receiver noise. Because the differentiation between
⎝ ⎠ ⎝ ⎠ multipath and antenna phase centre effects is difficult to
achieve under field conditions, we generally merge them
where together and define them as the antenna effect. Compared
ψ,θ,ϕ denote the heading, pitch and roll with the high-performance systems, low cost systems are
vulnerable to these error sources. Figure 1 shows the
Proceedings of NTM 2004 Conference (Session A2), San Diego, CA, January 26-28, 2004, The Institute of Navigation 2/10
epoch-by-epoch rms double difference residuals using units in a kinematic test which will be explained at length
different grades of antennas with CMC Allstar receivers. in the following section. The discrete jumps with a
During four consecutive days, a different antenna pair magnitude of 0.1m seems to be caused by a half cycle slip.
was placed in the same location in order to experience the
same multipath environment and satellite geometry.
Therefore, the difference in the residuals is caused by the
antenna effect and receiver noise. The AT-575-104
antenna is a very low-cost passive antenna and usually
used in the vehicle navigation. The large rms residuals
and their low frequency variation indicate that the carrier
phase measurements are severely plagued by multipath
and phase centre variations. Similarly, another type of
vehicular low cost active antenna, namely the AT-575-70,
has a limited ability to mitigate the antenna effect, which
caused the rms residuals to be above 5 mm. Compared
with the first two vehicular usage antenna, the AT-575-68
model is designed for marine applications, has better
performance. However, the low frequency variation is
still visible in the time series. The NovAtel 600 antenna
is a high performance antenna with a very good phase Figure 2: Double difference rms carrier phase
centre stability and a well-shaped gain pattern to reject residuals – Kinematics Mode
satellite signals with low elevation angles. It can be seen
that the rms residuals have small magnitude and noise- This kind of small cycle slips severely deteriorates the
like behavior, which indicates the antenna effect is much performance of cycle slip detection in an attitude
lower. determination system. Usually, the phase prediction and
the residual check method are used for cycle slip
detection when the single frequency is available. However,
severe multipath and phase centre variation effects can
produce the same error on the double difference
observables as well. Selecting feasible thresholds to
isolate the cycle slips from the combined effect of
antennas and receiver noise in the double difference
observables is nearly impossible. If the false alarm is
given by the detection functions, it will be very difficult
to instantaneously solve the correct ambiguity set in this
type of environment. It is crucial to implement some
integration theme to augment the cycle slip detection
scheme as well as the ambiguity resolution in the low cost
attitude determination system.
Proceedings of NTM 2004 Conference (Session A2), San Diego, CA, January 26-28, 2004, The Institute of Navigation 3/10
level frame, provided the double difference ambiguities 20 using the cube definition with a side of 20 cm. With
are correctly determined. Then the antenna vector such a small number of candidate combinations, the
solutions from GPS are fused with the rate gyro integer ambiguities could be successfully determined in
measurements in a Kalman filter to estimate the attitude less than 1 s in a static test.
parameters as well as attitude rates and gyro biases. If the Zb
carrier phase ambiguities are not fixed to integer values,
the search process has first to be completed in order to
determine the true ambiguity set for the antenna vectors
before attitude estimation. If the ambiguities cannot be
correctly determined for the current epoch, the attitude
angles and their angular rates are estimated from angular
Primary Ant
rate data only. Yb
Secondary Ant 1
Secondary Ant 2
Xb
Figure 4: Cube ambiguity search region
HARDWARE
Proceedings of NTM 2004 Conference (Session A2), San Diego, CA, January 26-28, 2004, The Institute of Navigation 4/10
measurements are available. During GPS outages, the bias rotation matrix with respect to the state vector in Equation
estimates remain fixed and are used to compensate their 1:
effects on angular rate output. Compared to the gyro bias,
the scale factor is not so sensitive to temperature and the ∂R
values are very close to 22 mV°/s within a range of 30 H = (3)
degrees. For this reason, the scale factor can be
3 n×9 gps ∂X
determined once and used for the entire navigation
mission, since the temperature does not change greatly in where n is the number of antenna vectors that have been
several hours. The high frequency noise in the angular solved by GPS carrier phase measurements.
velocity data can be easily suppressed when averaging the
high frequency gyro data to 10 Hz. The gyro has also The relation between the rate gyro measurements, the
shown limited endurance to shock and vibration. In three Euler angles and the gyro biases is given by
vehicular attitude determination mode, the vibration of the
platform varies significantly depending on the engine ⎛ ω z ⎞ ⎛ c(ϕ )c(θ ) − s (θ ) 0 ⎞ ⎛ψ& ⎞ ⎛ δω z ⎞
velocity, temperature and many other factors (Stephen ⎜ ⎟ ⎜ ⎟ ⎜ ⎟ ⎜ ⎟
2000). It is very hard to develop a valid model to ⎜ ω x ⎟ = ⎜ s (ϕ )c(θ ) c(ϕ ) 0 ⎟ ⋅ ⎜ θ& ⎟ + ⎜ δω x ⎟ (4)
compensate for the angular rate measurement errors ⎜ ω ⎟ ⎜ − s (θ ) 1 ⎟⎠ ⎜⎝ ϕ& ⎟⎠ ⎜⎝ δω y ⎟⎠
caused by the vibration of the platform. ⎝ y⎠ ⎝ 0
⎛1 0 0 dt 0 0 0 0⎞ 0
⎜ ⎟
⎜0 1 0 0 dt 0 0 0 0 ⎟
⎜0 0 1 0 0 dt 0 0 0 ⎟
⎜ ⎟ (5)
Figure 5: Murata rate gyro ⎜0 0 0 1 0 0 0 0 0⎟
φ = ⎜⎜ 0 0 0 0 1 0 0 0 0 ⎟⎟
⎜0 0 0 0 0 1 0 0 0⎟
INTEGRATION ALGORITHM ⎜ ⎟
⎜0 0 0 0 0 0 1 0 0⎟
⎜0 0 0 0 0 0 0 1 0⎟
⎜⎜ ⎟
0 0 0 0 1 ⎟⎠
The data fusion for the GPS/gyro integrated attitude
⎝0 0 0 0
system has been realized in an extended centralized
Kalman filter. The advantages of using the centralized
Kalman filter instead of the de-centralized one are the The Q matrix, which represents the process noise in the
tight data fusion and the better error detection. As Kalman filter, can be written as
mentioned above, after determining the double difference
⎛ σ ψ2& 3 σ ψ2& ⎞
ambiguities and the inter-antenna vector, the observables ⎜ dt 0 0 dt 2 0 0 0 0 0 ⎟
⎜ 3 2 ⎟ (6)
from GPS are the 3D antenna vector components in the ⎜ σ θ2& σ θ2& ⎟
⎜ 0 0 ⎟
3 2
dt 0 0 dt 0 0 0
local level frame. The measurements from the rate gyros ⎜ 3 2 ⎟
⎜ σ ϕ2& σ ϕ2& ⎟
are the angular rates around the three axes in the body ⎜ 0 0 dt 3
0 0 dt 2
0 0 0 ⎟
3 2
frame ( ω x , ω y , ω z ). The state vector consists of three
⎜ 2 ⎟
⎜ σ ψ& dt 2 0 0 σ 2
0 0 0 0 0 ⎟
Q=⎜ 2 ψ&
⎟
gyro biases, three Euler attitude parameters and their ⎜ σ θ2& ⎟
⎜ 0 dt 2 0 0 σ θ2& 0 0 0 0 ⎟
angular rates: ⎜ 2 ⎟
⎜ σ ϕ2& ⎟
⎜ 0 0 dt 2 0 0 σ ϕ2& 0 0 0 ⎟
⎜ 2 ⎟
X=ψ ( θ ϕ ψ& θ& ϕ& δω z δω x δω y )
T
(2) ⎜ 0
⎜ 0
0
0
0
0
0
0
0
0
0
0
σ w2
0
x
0
σ w2
0 ⎟
0 ⎟
⎜ y
⎟
⎜ 0 0 0 0 0 0 0 0 σ w2 z ⎟⎠
⎝
The design matrix for the GPS vector component
observables consists of the partial derivatives of the
Proceedings of NTM 2004 Conference (Session A2), San Diego, CA, January 26-28, 2004, The Institute of Navigation 5/10
The numerical value of the angular rate variance ( δ rate ) sensors was processed with a modified version of
2
HEADRT+TM.
in Equation 6 depends on the tightness of the dynamic
constraint in the Kalman filter and the variance of the The attitude results from the Kalman filter using GPS data
gyro bias estimate represents the stability of the bias drift. only are shown in Figure 6 and the corresponding
statistics are listed in Table 1. The attitude parameter
A quality control system based on innovation sequences, estimates contain low frequency fluctuations, which are
which has been successfully implemented in the unaided due to the impact of multipath and antenna phase centre
GPS attitude determination system (Wang & Lachapelle variations. The Kalman filter process could not entirely
2002), is also employed in the filtering process for remove the high noise level in the attitude estimates, as
GPS/gyro integration. With the introduction of angular the short inter-antenna distances did not dilute the
rate measurements from rate gyros in the Kalman filter, a receiver noise effect on attitude estimates.
more robust estimation of the attitude rates can be
obtained, which eventually improves the sensitivity of Then the measurements from the rate gyros were
error detection in the quality control system. integrated with the GPS data with a modified Kalman
filter. During the process, it was found that the gyro bias
During GPS outages, no antenna vector solutions are estimates were not stable due to the high noise level in the
available and the attitude parameters are determined by angular rate measurements even after gyro data
integrating the attitude rates over the time interval. The resampling. A smoothing process with a window length
attitude rates are estimated directly from the gyro data of 20 s was introduced to suppress noise effects on these
after compensating for the gyro biases using the following estimates since the gyro bias drifts smoothly over time.
equation:
As low cost rate gyros have good accuracy over very
⎛ s (ϕ ) c(ϕ ) ⎞ short intervals, the use of gyro measurements can
⎛ψ& ⎞ ⎜ 0 c(θ )
⎟
c(θ ) ⎟⎛⎜ ω y − δω y ⎞⎟ significantly decrease the noisy behavior of the attitude
⎜ ⎟ ⎜ estimates. As a result, the estimated attitude component
⎜ θ& ⎟ = ⎜ 0 c(ϕ ) − s (ϕ ) ⎟⎜ ω x − δω x ⎟ (7) noise level, shown in Figure 7, is significantly smaller
⎜ ϕ& ⎟ 1 s (ϕ )t (θ ) c(ϕ )t (θ ) ⎟⎜ ω − δω ⎟
⎜
⎝ ⎠ ⎜ ⎟⎝ z z ⎠
than those of Figure 6. However, as the rate gyros can
only sense the angular rates and the integrated attitude
⎝ ⎠ errors from gyro data only grow rapidly with time, the
where t () denotes the tangent absolute attitude parameters are primarily derived from
GPS. From the attitude statistics shown in Table 2, it has
From the last equation, one can see that the estimation of been found that the low frequency variations due to
attitude rates is related not only to the rate gyro multipath and phase center variations cannot be removed
measurements, but with the gyro bias and attitude using rate gyro aiding, as was anticipated. This is why the
parameter estimation as well. standard deviations given in Table 2 are as large as those
given in Table 1.
STATIC TEST
Proceedings of NTM 2004 Conference (Session A2), San Diego, CA, January 26-28, 2004, The Institute of Navigation 6/10
Table 1: Standalone GPS attitude estimate statistics - filter. The three estimated gyro biases closely coincide
Static test (Degrees) with the true values.
Heading Pitch Roll
Mean 268.60 1.08 2.68
St. Dev. 0.19 0.53 1.37
Proceedings of NTM 2004 Conference (Session A2), San Diego, CA, January 26-28, 2004, The Institute of Navigation 7/10
Due to the lack of precise alignment of the various
KINEMATIC TEST instruments during the hardware installation process, the
different attitude platforms were not perfectly parallel.
After examining the performance of the system in static The small misalignment angles have to be precisely
mode, a road kinematic test was conducted to investigate determined prior to the comparison of the estimated
its performance. In order to achieve measurement attitude results from each system. The misalignment
redundancy for the GPS attitude estimation, a fourth GPS angles were estimated using the technique described by
unit was added to the system. The baseline lengths for the Wang (2003).
three inter-antenna vectors were 0.6, 0.8 and 1.0 m,
respectively. A medium-performance GPS/INS system, During the data processing phase, the carrier phase
namely the NovAtel BlackDiamond™, was used with the measurements from the Beeline™ units were found quite
SAINTTM (Satellite and Inertial Navigation Technology) good and the true double differenced ambiguities were
software (Petovello 2003) during the test to provide solved instantaneously at the start of the test. No cycle
independent and accurate reference, as shown in Figure slip was detected and the integer ambiguities for the three
10. The standard deviations of the BlackDiamond™/ antenna vectors were correctly fixed during the entire test
SAINTTM derived attitude estimates were always within 3 run. When the estimated attitude parameters are compared
arcmins during the test. A high performance GPS multi- with the reference results, the attitude estimation errors
antenna attitude system consisting of NovAtel Beeline™ and their statistics are shown in Figure 12 and Table 4,
receivers and 501 antennas was also used for further respectively. The rms for heading is 0.42 degrees and the
comparisons using different GPS receiver grades. The corresponding values for pitch and roll are 0.68 and 0.85
antenna and inertial equipment setup on the 2001 Dodge degrees, respectively. Taking the short inter-antenna
Grand Caravan test vehicle is shown in Figure 11. The distances into account, these rms values are satisfactory.
misalignment between the body frames of the GPS and
inertial attitude systems was of the order of 1 to 2 degrees. As may be expected, the carrier phase measurements
During the 16-minute test run, the average velocity of the using the low cost CMC receivers and AT575-70
vehicle was 70-90 km/hr, which introduced some antennas are affected by multipath and antenna phase
vibration and jerk on the platform. centre variations as well as cycle slips. The double
difference residuals reached 7-8 cm even though the
integer ambiguities were correctly determined. This kind
of noisy carrier phase measurements not only results in
poor attitude parameter estimation accuracy, but also
leads to difficulties in ambiguity resolution and cycle slip
detection. Currently a residual check is used in
HeadRT+TM to identify the correct ambiguity set as well
as to detect small cycle slips (0.5 or 1 cycle). Large
carrier phase measurement errors due to antenna phase
center effects and multipath make this check too sensitive
if the tolerance selected is as small as that used for the
Beeline™ system. However, choosing a higher threshold
for the residual check is very risky as it may lead to
wrong ambiguity combinations passing through the
ambiguity distinguishing process. In this test, the above
Figure 10: Attitude reference outputs - Kinematic test criterion was optimistic in order to reject any incorrect
ambiguity set since the rate gyros can ensure availability
when GPS solutions are not available. As a result of
choosing a small tolerance, the fixed double difference
ambiguities were frequently identified as erroneous and
the ambiguity resolution restarted very often for the large
double difference phase residuals. Even though false
alarms may be caused, it does not affect the attitude
estimation performance provided the correct double
difference ambiguities can be resolved again
instantaneously. However, when the sphere search
Figure 11: Antenna setup - Kinematic test volume was used for the ambiguity resolution process, the
entire process took 10-20 s to determine the integer
ambiguity sets, 20 % of which were identified as
Proceedings of NTM 2004 Conference (Session A2), San Diego, CA, January 26-28, 2004, The Institute of Navigation 8/10
erroneous by the quality control system. Compared to the
sphere volume method, the cube search region definition
significantly reduced the search volume and the number
of candidate ambiguities, which resulted in faster and
reliable ambiguity resolution. In this test, the integer
ambiguities could be correctly selected in less than 1 s for
91% of the cases using the cube search method.
Proceedings of NTM 2004 Conference (Session A2), San Diego, CA, January 26-28, 2004, The Institute of Navigation 9/10
especially useful when the platform dynamics is
predictable.
REFERENCES
Proceedings of NTM 2004 Conference (Session A2), San Diego, CA, January 26-28, 2004, The Institute of Navigation 10/10