Integration of GNSS Precise Point Positioning and Reduced Inertial Sensor System For Lane Level Car Navigation
Integration of GNSS Precise Point Positioning and Reduced Inertial Sensor System For Lane Level Car Navigation
Integration of GNSS Precise Point Positioning and Reduced Inertial Sensor System For Lane Level Car Navigation
Abstract— The last decade has witnessed a growing demand for I. I NTRODUCTION
precise positioning in many applications, including autonomous
car navigation. The safety features in autonomous driving and
Advanced Driver Assistance Systems (ADAS) require lane-level
T HE emerging applications in the automotive industry,
such as autonomous driving and Advanced Driver Assis-
tance Systems (ADAS) require navigation systems with high
positioning accuracy. Such accuracy can be obtained from the
Global Navigation Satellite Systems (GNSS) through either dif- accuracy, reliability, and integrity [1]. Safety features such
ferential techniques or Precise Point Positioning (PPP). PPP is as lane-departure warning cannot be achieved without lane-
currently favored over differential GNSS because it provides a level positioning accuracy. A common approach for lane-
global solution without the need for local reference stations. Nev- level positioning is to calculate the vehicle position in the
ertheless, employing PPP for land vehicles would be challenging
due to frequent signal degradation and blockage. Integrating Earth-Centered Earth-Fixed (ECEF) frame and then match this
PPP with an Inertial Navigation System (INS) can solve the location to a digital map [1], [2]. Therefore, the accuracy of
solution continuity problem; however, the INS solution drifts over both the ECEF position and the road map impacts the final
time, resulting in losing the desired accuracy. Implementing a solution [2]. The focus of this work is to enhance the estimated
reliable PPP/INS system that can preserve the required accuracy vehicle position in the ECEF frame.
is not trivial, especially with financial and computational cost
constraints. This article proposes the integration of PPP with GNSS positioning is a vital component of all car navigation
the Reduced Inertial Sensor System (RISS) for lane-level car systems. However, for lane-level positioning, the Standard
navigation. The high-precision needed in lane-level positioning Point Positioning (SPP) with meter-level accuracy is no longer
can be achieved by integrating PPP with high-end INS. Since sufficient. An average lane width can be approximately 3 m.
high-end INS are expensive, this work proposes the use of RISS For example, the lane widths guide of the city of Toronto in
instead of the traditional INS. RISS uses only one gyroscope and
two accelerometers, which can save more than half the high-end June 2017 has recommended lane widths between 3 and 4.3 m
INS cost. The proposed PPP/RISS system was tested through for the main driving lanes [3]. If the lane width is 3 m and the
three road tests that included highway driving under several car width is assumed to be 2 m, as shown in Fig. 1, positioning
overpasses. The system was able to maintain horizontal position accuracy of half the lane width might be enough to match
errors of less than 50 cm. the car to a specific lane; however, for safety applications,
Index Terms— Precise point positioning, global navigation accuracy less than 50 cm is required.
satellite system, inertial sensors, car navigation, lane-level, high- Centimeter-level GNSS accuracy can be obtained using Dif-
way driving, autonomous driving. ferential GNSS (DGNSS) or Precise Point Positioning (PPP)
[4]. The developed system is based on PPP since it requires
Manuscript received June 9, 2019; revised March 12, 2020, August 14, less infrastructure than DGNSS and provides a globally-
2020, and November 12, 2020; accepted November 23, 2020. This work consistent solution [5]. Still, GNSS positioning cannot be used
was supported by the Natural Sciences and Engineering Research Council of
Canada (NSERC) under Grant RGPIN-2020-03900 and Grant STPGP 521432. alone for vehicle navigation because the GNSS signal is prone
The Associate Editor for this article was Z. M. Kassas. (Corresponding to interference and obstruction [6]. For applications such as
author: Mohamed Elsheikh.) autonomous driving, multisensor fusion is typically the case
Mohamed Elsheikh is with the Department of Geomatics Engineering, Uni-
versity of Calgary, Calgary, AB T2N 1N4, Canada, also with the Department where sensors such as the Inertial Navigation System (INS),
of Electrical and Computer Engineering, Queen’s University, Kingston, ON odometer, Light Detection and Ranging (LiDAR), and cameras
K7L 3N6, Canada, and also with the Department of Electronics and Electrical can be employed. Each sensor has its pros and cons. For
Communication Engineering, Tanta University, Tanta 31512, Egypt (e-mail:
mohamed.elsheikh@ucalgary.ca). example, cameras are useful in detecting the road features,
Aboelmagd Noureldin is with the Department of Electrical and Computer but they cannot work in adverse weather conditions such as
Engineering, Queen’s University, Kingston, ON K7L 3N6, Canada, and rain and snow. On the other hand, the integrated GNSS/INS
also with the Department of Electrical and Computer Engineering, Royal
Military College of Canada, Kingston, ON K7K 7B4, Canada (e-mail: solution is weather independent but suffers from the effects of
aboelmagd.noureldin@rmc.ca). multipath and obstacles on GNSS signals and the error drift of
Michael Korenberg is with the Department of Electrical and Computer the INS. This article focuses on an efficient GNSS/INS fusion,
Engineering, Queen’s University, Kingston, ON K7L 3N6, Canada (e-mail:
korenber@queensu.ca). which, when integrated with other sensors, will contribute to
Digital Object Identifier 10.1109/TITS.2020.3040955 enhancing the overall system performance.
1524-9050 © 2020 IEEE. Personal use is permitted, but republication/redistribution requires IEEE permission.
See https://www.ieee.org/publications/rights/index.html for more information.
Authorized licensed use limited to: TONGJI UNIVERSITY. Downloaded on June 11,2021 at 05:24:11 UTC from IEEE Xplore. Restrictions apply.
This article has been accepted for inclusion in a future issue of this journal. Content is final as presented, with the exception of pagination.
Authorized licensed use limited to: TONGJI UNIVERSITY. Downloaded on June 11,2021 at 05:24:11 UTC from IEEE Xplore. Restrictions apply.
This article has been accepted for inclusion in a future issue of this journal. Content is final as presented, with the exception of pagination.
ELSHEIKH et al.: INTEGRATION OF GNSS PPP AND RISS FOR LANE-LEVEL CAR NAVIGATION 3
The next section describes the utilized PPP model. is the speed of light, dtr, PI F is the receiver clock bias of the IF
Section III is a review of RISS describing its mechaniza- pseudorange observations in seconds, λ I F is the IF wavelength
tion equations in addition to its advantages and limitations. in meters, N I F denotes the IF float ambiguity in cycles, and
The developed PPP/RISS integration model is illustrated in denotes the multipath and receiver noise in meters. It is
section IV. Section V shows the experimental setup in the per- worth mentioning that dtr, PI F was used in both pseudorange
formed road tests. The testing results are shown in section VI, and carrier phase observations since the difference between
focusing on how the developed PPP/RISS system could main- code (pseudorange) and phase biases is absorbed into the float
tain lane-level accuracy on highways. Finally, section VII ambiguity parameter.
concludes the presented work. The observations of the Russian Global Navigation Satellite
System (GLONASS) were also employed to increase the
II. P RECISE P OINT P OSITIONING M ODEL number of visible satellites. The corrected GLONASS mea-
In this work, the standard PPP model is adopted, which surements can be written as
is based on the ionospheric-free (IF) combinations of dual- Pr,s,R s,R
I F = ρr + cdtr, PI F + I S BG−R + m w Z r,w + r, PI F
s s
frequency GNSS measurements with float ambiguity resolu-
(5)
tion [16]. Besides, corrections for satellite orbits, clocks, phase s,R
and code biases from a global network are employed to achieve r, IF = ρrs + cdtr, PI F + I S BG−R + m sw Z r,w + λs,R s
I F NI F
the high precision of the PPP solution. The PPP algorithm also + r,s,R
I F (6)
applies corrections for the relativistic and Sagnac effects [17].
Furthermore, additional error sources have to be considered in where the superscript R refers to GLONASS. GLONASS
PPP that used to be ignored in SPP or canceled in DGNSS, observations have an extra unknown, which is the Inter-System
such as the phase wind-up, antenna phase center, and site Bias (ISB) between GPS and GLONASS clock systems,
displacements [18]. in meters. Besides, the IF wavelength for GLONASS is not
The tropospheric delays consist of dry and wet components. only different from GPS, but it is also different for each satel-
The dry component accounts for 90% of the delay, and it can lite due to the employment of the Frequency Division Multi-
be accurately modeled. In contrast, the wet component, which ple Access (FDMA) technique in GLONASS legacy signals.
is responsible for 10% of the delay, is difficult to model as the This frequency difference results in an additional satellite-
water vapor content varies locally [19]. For centimeter-level dependent bias called the Inter-Frequency Bias (IFB) or Inter-
positioning, the total tropospheric delay T for each satellite s Channel Bias (ICB). Nevertheless, in float-ambiguity PPP,
at the GNSS receiver r can be parametrized as [18] the phase IFBs are absorbed in the estimated float ambiguities
[23]. On the other hand, GLONASS code IFBs are difficult
Trs = m h (E s )Z r,h + m w (E s )Z r,w (1) to estimate, and there are no available corrections for them.
Besides, they only affect the initial PPP convergence, espe-
where E s is the satellite elevation angle, whereas Z r,h is the
cially in fixed-ambiguity PPP; therefore, they were neglected
zenith hydrostatic delay, and Z r,w is the zenith wet delay at
in the implemented float-ambiguity PPP.
the receiver location. The terms m h and m w represent the
Another GNSS useful observation is the Doppler measure-
elevation-dependent mapping functions of the hydrostatic and
ment. Doppler measurements can be used to calculate the
wet components, respectively.
GNSS receiver velocity. Furthermore, in GNSS/INS integra-
In our algorithm, Z r,h was calculated using [20]
tion, it can provide an update to the vehicle velocity, which can
0.0022768P contribute to a faster estimation of the INS attitude and IMU
Z r,h = (2)
1 − 0.00266 cos(2ϕ) − 2.8 ∗ 10−7 h errors [6]. The Doppler measurements D H z provided by GNSS
where P is the surface pressure in hPa, ϕ is the latitude in receivers represent the Doppler shift in Hz. The measured
degrees, and h is the height in meters. For centimeter-level PPP pseudorange rate D in m/s is obtained by multiplying the
accuracy, the pressure (in hPa) can be approximated by Berg’s Doppler shift by its corresponding wavelength with a negative
formula P = 1013.25(1 − 2.2557 ∗ 10−5 h)5.2568 [21]. On the sign
other hand, the wet component cannot be calculated with the D = −λ × D H z (7)
same accuracy and hence was estimated as an unknown in the
s
The corrected IF Doppler observation Dr,I
navigation filter. The mapping functions were computed using F is given by
Neill’s mapping functions [22].
˙ r, P + Ds
Dr,s I F = ρ˙rs + cdt (8)
After applying the corrections mentioned above, the cor- IF r,I F
s,G s,G
rected IF GPS pseudorange Pr,I F and carrier phase r,I F It should be noted that the above equation can be used for
observations can be formulated as both GPS and GLONASS since the change of the receiver
Pr,s,G s,G clock is the same for both constellations as they use the same
I F = ρr + cdtr, PI F + m w Z r,w + r, PI F
s s
(3)
s,G oscillator.
r, IF = ρrs + cdtr, PI F + m sw Z r,w + λG s
I F NI F + r,s,G
I F
Authorized licensed use limited to: TONGJI UNIVERSITY. Downloaded on June 11,2021 at 05:24:11 UTC from IEEE Xplore. Restrictions apply.
This article has been accepted for inclusion in a future issue of this journal. Content is final as presented, with the exception of pagination.
Authorized licensed use limited to: TONGJI UNIVERSITY. Downloaded on June 11,2021 at 05:24:11 UTC from IEEE Xplore. Restrictions apply.
This article has been accepted for inclusion in a future issue of this journal. Content is final as presented, with the exception of pagination.
ELSHEIKH et al.: INTEGRATION OF GNSS PPP AND RISS FOR LANE-LEVEL CAR NAVIGATION 5
the trapezoidal rule. and corrected using the PPP network corrections and error
models. On the other hand, the RISS mechanization output
h k = h k−1 + 0.5(v u k + v u k−1 )t (15) is converted to measurement-like values. Then, the measure-
0.5(v nk + v nk−1 ) ment errors, which are the differences between the predicted
ϕk = ϕk−1 + t (16)
RM + hk measurements and the real GNSS measurements, are fed
0.5(v ek + v ek−1 ) to an Extended Kalman Filter (EKF). The filter fuses the
λk = λk−1 + t (17)
(R N + h k ) cos ϕk measurement errors with the corresponding ones from the
where R M is the meridian Earth radius, and R N is the normal system error model and generates the final estimated position,
Earth radius. velocity, and attitude errors. Fig. 3 also shows the closed-loop
structure of the system. The estimated navigation parameters
are fed back after each epoch to the RISS mechanization
B. RISS Advantages and Limitations module. Moreover, the estimated sensor biases are corrected
The use of RISS has several advantages over full IMU using the estimated values of their errors. This feedback resets
and other reduced INS systems, which can be summarized the error states every epoch and assures that the linearity
as follows: assumption of the EKF is maintained.
• The elimination of two gyroscopes and one accelerometer
reduces the overall cost and minimizes the error accumu- A. System Model
lation compared to the full IMU. The system error model consists of the INS error states
• The reduction of INS sensors reduces the computational
augmented with error states related to PPP. The number of
complexity and power consumption of the system. error states in the system model is (13 + M) error states where
• Using the odometer removes one mathematical integra-
M is the number of satellites used in the solution. The state
tion step required when only accelerometers are used, vector δX can be written as
eliminating the error growth in the velocity.
• Using the odometer with the horizontal accelerometers δX = [δrl δvl δA δaod δ Bz δ Br
allows the calculation of the pitch and roll angles using δd Br,G−R δdr δ Zw δNIF ]T (18)
(9) and (10).
• Using the odometer speed as a control input rather where rl and vl are the vehicle position and velocity vectors
than an update eliminates the need to apply algorithms in the LLF. The error in the azimuth angle is denoted δ A,
such as Zero-velocity Update (ZUPT) and Nonholonomic whereas δaod represents the odometer acceleration error. δ Bz
Constraints (NHC). Furthermore, the odometer is an is the error in the vertical gyroscope bias. The term Br is
integrated part of any land vehicle, and hence, there is the GNSS receiver clock bias in meters, which is equal to
no extra cost in utilizing the odometer data. ˙ r is the GNSS receiver
cdtr, PI F . Similarly, the term dr = cdt
• The calculated pitch and roll angles are used in RISS to clock drift in m/s. The ISB between GPS and GLONASS is
estimate the off-plane vehicle motion. denoted d Br,G−R . The error in zenith wet tropospheric delay
• Calculating pitch and roll angles from the accelerometers is represented by δ Z w , whereas the vector δNIF represents the
rather than the gyros includes no mathematical integra- errors in the float ambiguities.
tion, which means no drift or error growth [7]. The system model can be described by the formula
On the other hand, one limitation of RISS is that the calcu-
δ Ẋ = FδX + W (19)
lated pitch and roll are noisy because they are directly calcu-
lated from the sensor measurements. Furthermore, as with all where F is the system dynamic coefficient matrix, and W is
other reduced INS, the solution degrades if the land vehicle the process noise vector with covariance matrix Q [6].
constraints are not fulfilled (e.g., large pitch or roll angles and Since the system states are error states, the elements of
vertical motion). the F matrix can be obtained from the total derivative linear
approximation of the time rate of change of the system
IV. PPP/RISS I NTEGRATION states. For example, the time rate of change of the latitude
is calculated by
This section presents the developed PPP/RISS system with a
description of its system and measurement models. For the best vn
ϕ̇ = (20)
integration performance, the TC integration mode is chosen Rm + h
such that RISS can contribute to estimating the PPP parameters Applying the total derivative leads to
and hence reduce the solution re-convergence time after GNSS
1 vn
outages. Furthermore, the TC integration is performed on the δ ϕ̇ = δv n − δh (21)
measurement level, which means that the final PPP solution Rm + h (Rm + h)2
is not necessary, and any available measurements can be used which indicates that δ ϕ̇ depends on the changes in both v n
to update the navigation filter. and h. Although values like (R v+h)
n
2 are very small, they were
m
The block diagram of the developed PPP/RISS system is included in the developed system model to reduce the error
shown in Fig. 3. The raw pseudoranges, carrier phase, and accumulation and achieve the best performance in the long
Doppler measurements are obtained from the GNSS receiver term. The derivation of the other INS error states when using
Authorized licensed use limited to: TONGJI UNIVERSITY. Downloaded on June 11,2021 at 05:24:11 UTC from IEEE Xplore. Restrictions apply.
This article has been accepted for inclusion in a future issue of this journal. Content is final as presented, with the exception of pagination.
⎡ 1 ⎤
RISS is beyond the scope of this discussion and can be found 0 0
⎢ RM + h ⎥
in [31]. ⎢ ⎥
F2 = ⎢ 1
0⎥ (25)
The error in the GNSS receiver clock is represented by two ⎣ 0 ⎦
(R N + h) cos ϕ
states, the clock bias and the clock drift, similar to [32], [33].
0 0 1
The clock error model is described by ⎡ −v tan ϕ ⎤
v e sec ϕ
2
e
⎢ v n ωe cos ϕ + R + h 0 vn
(R N + h)2 ⎥
δ Ḃr 0 1 δ Br w Br ⎢ N
2 −v tan ϕ ⎥
δ d˙r
=
0 0 δdr
+
wdr
(22) F3 = ⎢
⎢−v ω cos ϕ + v e sec ϕ e
⎥
⎥
⎣ e e 0 −v e
RN + h (R N + h)2 ⎦
where w Br and wdr represent the white Gaussian process noise 0 0 0
that satisfies the assumptions of the EKF [30], for the receiver (26)
⎡ v n tan ϕ v e tan ϕ ⎤
clock bias and clock drift, respectively. −ωz +we sin ϕ + 0
⎢ RN + h R N +h ⎥
The other states that have no deterministic formulas must ⎢ ⎥
be modeled using proper stochastic models. In the developed F4 = ⎢ω −w sin ϕ − 2v e tan ϕ 0⎥
⎣ z e
R N +h
0 ⎦
system, the vertical gyro bias and odometer acceleration errors
0 0 0
were modeled by the first-order Gauss-Markov process with
correlation times β Bz and γaod , respectively. The errors in (27)
⎡ ⎤
the wet tropospheric delay and ISB terms were modeled aod cos A cos p sin A cos p vn
F5 = ⎣ −aod sin A cos p cos A cos p −v e ⎦ (28)
as random walk processes since they have slow variations
overtime. Finally, the float ambiguities were considered as 0 sin p 0
⎡ ⎤
random constants. v e sec2 ϕ −v e tan ϕ
The F matrix can now be written as ⎢ωe cos ϕ + R + h 0 (R + h)2 ⎥
F6 = ⎢ N N ⎥ (29)
⎣ 0 0 0 ⎦
⎡ ⎤
F1 F2 03×3 03×3 03×1 03×M 0 0 0
⎢ F3 F4 F5 03×3 03×1 03×M ⎥ ⎡ tan ϕ ⎤
⎢ ⎥
⎢ F6 F7 F8 03×3 03×1 03×M ⎥ 0 0
F =⎢ ⎢ 03×3
⎥
F7 =
⎢ RN + h ⎥
⎢ 03×3 03×3 F9 03×1 03×M ⎥ ⎥
⎣ 0 0 0⎦ (30)
⎣ 01×3 01×3 01×3 01×3 0 01×M ⎦ 0 0 0
0 M×3 0 M×3 0 M×3 0 M×3 0 M×1 0 M×M ⎡ ⎤
0 0 1
(23) F8 = ⎣0 −γaod 0 ⎦ (31)
0 0 −β Bz
where the matrices F1 to F9 are given by ⎡ ⎤
0 0 1
⎡ ⎤ F9 = ⎣0 0 0⎦ (32)
−v n
0 0 0 0 0
⎢ (R M + h)2 ⎥
⎢ v tan ϕ −v e ⎥
F1 = ⎢ e
0 ⎥ (24) The state transition matrix φ is approximated from F using
⎣ (R + h) cos ϕ (R N + h) cos ϕ ⎦
2
N
0 0 0 φ ≈ I + Ft (33)
Authorized licensed use limited to: TONGJI UNIVERSITY. Downloaded on June 11,2021 at 05:24:11 UTC from IEEE Xplore. Restrictions apply.
This article has been accepted for inclusion in a future issue of this journal. Content is final as presented, with the exception of pagination.
ELSHEIKH et al.: INTEGRATION OF GNSS PPP AND RISS FOR LANE-LEVEL CAR NAVIGATION 7
Authorized licensed use limited to: TONGJI UNIVERSITY. Downloaded on June 11,2021 at 05:24:11 UTC from IEEE Xplore. Restrictions apply.
This article has been accepted for inclusion in a future issue of this journal. Content is final as presented, with the exception of pagination.
TABLE II the EKF, the new estimated covariance values are carefully
T HE A DOPTED N UMERICAL VALUES FOR THE S TANDARD D EVIATION OF updated in the big P matrix.
THE U TILIZED GNSS O BSERVATIONS
2) Cycle Slip Detection: The primary challenge of using
carrier phase observations is the problem of cycle slips.
A cycle slip means a loss of carrier tracking, which can happen
due to a signal blockage or weak signal-to-noise ratio. When
a cycle slip occurs, the ambiguity changes and the assumption
that it is constant is not valid anymore. If the cycle slips are not
detected and based on their size, the solution deteriorates, and
the PPP precision may be lost. After a cycle slip is detected,
The update equations of the EKF can be written as there are two ways to deal with it. The first approach is to try
K k = Pk− HkT {Hk Pk− HkT + Rk }−1 (43) repairing it; nevertheless, an incorrect reparation will affect all
the following observations. The second approach is to reset
δXˆ + ˆ− ˆ−
k = δXk + K k (δZk − Hk δXk ) (44) the ambiguity parameter in the navigation filter to estimate
Pk+ = (I − K k Hk )Pk− (45) the new ambiguity, which is a safer method [35] despite the
required re-convergence time.
where K k is the Kalman gain.
There are several cycle slip detection methods in the lit-
erature; however, none can achieve 100% detection success.
C. Practical Considerations Each method has advantages and limitations. In the developed
Although the description of the system and measurement algorithm, the cycle slip detection module uses two methods to
models of the EKF seems to be sufficient for implementing detect the cycle slips from the PPP measurements. A cycle slip
the integration algorithm, other practical considerations should flag is raised if any of the two methods detected a cycle slip.
be taken into account for an efficient implementation of the The two methods, initially introduced in [36], are using the
system. In this section, three examples of these practical Melbourne-Wübbena (MW) function and using the Geometry-
considerations are briefly discussed. Free (GF) phase combination.
1) Dynamic Satellite Visibility: Due to the use of carrier The MW function can detect large cycle slips but might
phase observations, the system model has an ambiguity state not detect the small cycle slips and cycle slips that occur
for each satellite. The total number of system states in the equally on the two GNSS frequencies used to form the MW
developed TC PPP/RISS model is 13 + M; nevertheless, combination. Besides, the MW function is affected by the
the visible satellites vary with time due to the change in noise in the code observation. On the other hand, the GF phase
the satellite geometry and the signal blockage. Thus, care has low noise and can be used to detect small cycle slips,
must be taken between different processing epochs for the and equal cycle slips on both frequencies. However, the GF
appearance or disappearance of satellites, especially when phase cannot detect some combinations of cycle slips, and
updating the covariance of the float ambiguities in the P large changes in the ionospheric delay between the consecutive
matrix. epochs can affect the detection success.
A straightforward solution to this issue is to assume that all One of the advantages of the integration with INS is that
the satellites exist and design the system matrices based on the it can also contribute to cycle slip detection, which means
maximum possible number of satellites. However, using these an extra level of detection. In the implemented algorithm,
matrices in the EKF equations leads to high computational cost the carrier phase innovation sequence, which is the difference
and requires dealing with matrices with many zero entries and between the PPP measurements and the predicted measure-
might result in singularity issues. In the developed algorithm, ments from RISS, is checked against a predefined threshold
the system is designed for a maximum number of satellites = similar to the algorithm in [37]. If the innovation sequence
32 GPS + 26 GLONASS = 58, and hence, the total number was greater than the threshold, a cycle slip is declared.
of states is 58+13 = 71. However, for every epoch, before 3) Outlier Detection: Measurement outliers may seriously
applying the EKF equations, a submatrix P is taken from deteriorate the system performance if not handled properly. For
the original P matrix such that it contains only the covariance INS, the measurement outliers can result from sensor failures,
information for the 13+ M states in this epoch. After applying large sensor noise, or unexpected environment disruption.
⎡ ⎤
Hp 0 M×3 0 M×3 1 M×1 hb 0 M×1 mw 0 M×M
H = ⎣ Hp 0 M×3 0 M×3 1 M×1 hb 0 M×1 mw λ I F I M×M ⎦ . (38)
0 M×3 Hv 0 M×3 0 M×1 0 M×1 1 M×1 0 M×1 0 M×M
⎡ ⎤
−(R N + h) sin ϕ cos λ −(R N + h) cos ϕ sin λ cos ϕ cos λ
L = ⎣ −(R N + h) sin ϕ sin λ (R N + h) cos ϕ cos λ cos ϕ sin λ ⎦ (40)
(R N (1 − e2 ) + h) cos ϕ 0 sin ϕ
Authorized licensed use limited to: TONGJI UNIVERSITY. Downloaded on June 11,2021 at 05:24:11 UTC from IEEE Xplore. Restrictions apply.
This article has been accepted for inclusion in a future issue of this journal. Content is final as presented, with the exception of pagination.
ELSHEIKH et al.: INTEGRATION OF GNSS PPP AND RISS FOR LANE-LEVEL CAR NAVIGATION 9
Authorized licensed use limited to: TONGJI UNIVERSITY. Downloaded on June 11,2021 at 05:24:11 UTC from IEEE Xplore. Restrictions apply.
This article has been accepted for inclusion in a future issue of this journal. Content is final as presented, with the exception of pagination.
Fig. 4. Typical equipment setup on a van ready for road data collection.
Authorized licensed use limited to: TONGJI UNIVERSITY. Downloaded on June 11,2021 at 05:24:11 UTC from IEEE Xplore. Restrictions apply.
This article has been accepted for inclusion in a future issue of this journal. Content is final as presented, with the exception of pagination.
ELSHEIKH et al.: INTEGRATION OF GNSS PPP AND RISS FOR LANE-LEVEL CAR NAVIGATION 11
Fig. 7. Speed profile of the first trajectory. The speed was on average 15 km/h. Fig. 9. Horizontal position error comparison of the first trajectory with two
simulated 10 s GNSS outages introduced after 20 and 28.5 minutes.
Authorized licensed use limited to: TONGJI UNIVERSITY. Downloaded on June 11,2021 at 05:24:11 UTC from IEEE Xplore. Restrictions apply.
This article has been accepted for inclusion in a future issue of this journal. Content is final as presented, with the exception of pagination.
Fig. 10. Example of how the integration with RISS can affect the ambiguity Fig. 12. Number of visible GPS/GLONASS satellites in the second trajectory.
resolution using the estimated IF ambiguity of the GPS satellite G13. The two drops near the end are due to two overpasses.
Fig. 13. Speed profile of the second trajectory. The speed was above 60km/h
at 66% of the time.
Authorized licensed use limited to: TONGJI UNIVERSITY. Downloaded on June 11,2021 at 05:24:11 UTC from IEEE Xplore. Restrictions apply.
This article has been accepted for inclusion in a future issue of this journal. Content is final as presented, with the exception of pagination.
ELSHEIKH et al.: INTEGRATION OF GNSS PPP AND RISS FOR LANE-LEVEL CAR NAVIGATION 13
TABLE III
C OMPARISON OF THE RMS AND M AXIMUM H ORIZONTAL P OSITION
E RRORS IN THE S ECOND T RAJECTORY
Authorized licensed use limited to: TONGJI UNIVERSITY. Downloaded on June 11,2021 at 05:24:11 UTC from IEEE Xplore. Restrictions apply.
This article has been accepted for inclusion in a future issue of this journal. Content is final as presented, with the exception of pagination.
Fig. 17. Number of visible GPS/GLONASS satellites in the third trajectory. Fig. 19. Horizontal position error comparison in the third trajectory between
After 40 min, the car passed under several consecutive bridges. PPP and PPP/RISS solutions.
Fig. 18. Speed profile of the third trajectory. The speed was more than Fig. 20. Zoomed horizontal position error comparison in the third trajectory
60 km/h at 64% of the time. with a focus on the last 30 min that includes ten consecutive partial and full
GNSS outages.
Fig. 19 shows the horizontal position error of the PPP and
PPP/INS solutions versus time. Both solutions converged to TABLE IV
a 20 cm error level after 5.3 min. In the first 40 min where C OMPARISON OF THE RMS AND M AXIMUM H ORIZONTAL P OSITION
E RRORS IN THE T HIRD T RAJECTORY
the environment was mostly open-sky, the two solutions have
a comparable performance. However, once the car started to
move under the overpasses, the PPP solution suffered from
momentary GNSS outages, large error spikes up to 3.6 m,
and relatively long re-convergence periods. On the other hand,
the integrated PPP/RISS solution maintained the required
accuracy with maximum errors around 40 cm.
Fig. 20 zooms on the position errors in the last 30 minutes. when the vehicle was moving under the overpasses. Besides,
While the PPP solution struggled between outages to re- using a high-end INS with low bias instability was also a
converge, the integrated PPP/RISS solution provided a con- primary factor in limiting the error drift.
tinuous solution less than 20 cm most of the time with Table IV compares the rms and maximum errors of the
no or shorter convergence time after outages. The amount PPP and PPP/RISS solutions after 10 min of starting the
of re-convergence time reduction is mainly affected by the third trajectory. The integrated PPP/RISS solution has better
propagated INS accuracy at the end of the outage. This is why performance in terms of both rms and maximum error results.
the integration with INS can reduce the re-convergence time in The horizontal position errors of the developed PPP/RISS was
short GNSS outages better than long ones. During the GNSS less than 50 cm, not only in the rms sense but also in the
outages in this trajectory, the INS drift was relatively small, maximum errors. The consideration of the maximum error is
which indicates that the INS states were well estimated before crucial for safety applications.
the GNSS outages, especially the azimuth angle and the verti- Fig. 21 shows, on Google Earth, an example of one of
cal gyro bias. For example, the error in the estimated azimuth the GNSS outages where the car passed under the Highway
angle with respect to the reference solution was around 0.5◦ 1A bridge, and there was no PPP solution for four seconds.
Authorized licensed use limited to: TONGJI UNIVERSITY. Downloaded on June 11,2021 at 05:24:11 UTC from IEEE Xplore. Restrictions apply.
This article has been accepted for inclusion in a future issue of this journal. Content is final as presented, with the exception of pagination.
ELSHEIKH et al.: INTEGRATION OF GNSS PPP AND RISS FOR LANE-LEVEL CAR NAVIGATION 15
Authorized licensed use limited to: TONGJI UNIVERSITY. Downloaded on June 11,2021 at 05:24:11 UTC from IEEE Xplore. Restrictions apply.
This article has been accepted for inclusion in a future issue of this journal. Content is final as presented, with the exception of pagination.
[11] P. S. Henkel, “Tightly coupled precise point positioning and attitude [34] P. F. de Bakker and C. C. J. M. Tiberius, “Real-time multi-GNSS single-
determination,” IEEE Trans. Aerosp. Electron. Syst., vol. 51, no. 4, frequency precise point positioning,” GPS Solutions, vol. 21, no. 4,
pp. 3182–3197, Oct. 2015. pp. 1791–1803, Oct. 2017.
[12] G. Zhang and C. Wilson, “An integrated DGPS/DR/Map system for [35] G. Xu, GPS: Theory, Algorithms and Applications. Berlin, Germany:
vehicle safety applications,” in Proc. Nat. Tech. Meeting Inst. Navigat., Springer-Verlag, 2007.
Anaheim, CA, USA, Jan. 2000, pp. 253–257. [36] G. Blewitt, “An automatic editing algorithm for GPS data,” Geophys.
[13] J. Wang, S. Schroedl, K. Mezger, R. Ortloff, A. Joos, and T. Passegger, Res. Lett., vol. 17, no. 3, pp. 199–202, Mar. 1990.
[37] T. Takasu and A. Yasuda, “Cycle slip detection and fixing by MEMS-
“Lane keeping based on location technology,” IEEE Trans. Intell.
IMU/GPS integration for mobile environment RTK-GPS,” in Proc. 21st
Transp. Syst., vol. 6, no. 3, pp. 351–356, Sep. 2005.
Int. Tech. Meeting Satell. Division The Inst. Navigat. (ION GNSS),
[14] C. Guo, W. Guo, G. Cao, and H. Dong, “A lane-level LBS system for
Savannah, GA, USA, 2008, pp. 64–71.
vehicle network with high-precision BDS/GPS positioning,” Comput. [38] IMU-CPT Datasheet. Accessed: Nov. 1, 2020. [Online]. Available:
Intell. Neurosci., vol. 2015, pp. 1–13, Jan. 2015. https://hexagondownloads.blob.core.windows.net/public/Novatel/assets/
[15] Y. Ohshima et al., “Application of precise point positioning (PPP) Documents/Papers/IMU-CPT/IMU-CPT.pdf
and precise real-time ephemeris to achieve ‘where-in-lane’ positioning [39] IMU-KVH1750 Datasheet. Accessed: Nov. 1, 2020. [Online]. Available:
accuracy for vehicles,” in Proc. Pacific PNT Meeting (ION), Honolulu, https://novatel.com/products/span-gnss-inertial-navigation-systems/
HI, USA, Apr. 2015, pp. 583–590. span-imus/imu-kvh1750
[16] J. Kouba and P. Héroux, “Precise point positioning using IGS orbit and [40] O. Montenbruck et al., “The multi-GNSS experiment (MGEX) of the
clock products,” GPS Solutions, vol. 5, no. 2, pp. 12–28, Oct. 2001. international GNSS service (IGS)–achievements, prospects and chal-
[17] M. Karaim, M. Elsheikh, and A. Noureldin, “GNSS error sources,” in lenges,” Adv. Space Res., vol. 59, no. 7, pp. 1671–1697, Apr. 2017.
Multifunctional Operation and Application of GPS, R. B. Rustamov and [41] O. Montenbruck et al., “IGS-MGEX: Preparing the ground for multi-
A. M. Hashimov, Eds. Rijeka, Croatia: InTech, 2018, ch. 4, pp. 69–85. constellation GNSS science,” Inside GNSS, vol. 9, no. 1, pp. 42–49,
[18] J. Kouba, F. Lahaye, and P. Tétreault, “Precise point position- Jan. 2014.
ing,” in Springer Handbook of Global Navigation Satellite Systems,
Mohamed Elsheikh (Member, IEEE) was born in
P. J. Teunissen and O. Montenbruck, Eds. Springer, 2017, ch. 25,
Tanta, Egypt, in 1984. He received the B.Sc. and
pp. 723–751.
M.Sc. degrees in electrical engineering from Tanta
[19] J. J. Spilker, “Tropospheric effects on GPS,” in Global Positioning University, Tanta, in 2006 and 2013, respectively,
System: Theory Applications, vol. 1. 1996, pp. 517–546.
and the Ph.D. degree in electrical and computer
[20] J. L. Davis, T. A. Herring, I. I. Shapiro, A. E. E. Rogers, and G. Elgered, engineering from Queen’s University, Kingston, ON,
“Geodesy by radio interferometry: Effects of atmospheric modeling Canada, in 2019.
errors on estimates of baseline length,” Radio Sci., vol. 20, no. 6, He has been a Teaching Assistant and Assistant
pp. 1593–1607, Nov. 1985. Lecturer with Tanta University since 2007. From
[21] H. Berg, Allgemeine Meteorologie. Berlin, Germany: Dümmlers Verlag 2014 to 2019, he was a Teaching and a Research
Bonn, 1948. Assistant with Queen’s University and a member
[22] A. E. Niell, “Global mapping functions for the atmosphere delay at with the Navigation and Instrumentation Research Group, Royal Military
radio wavelengths,” J. Geophys. Res., Solid Earth, vol. 101, no. B2, College of Canada. He is currently a Post-Doctoral Associate with the
pp. 3227–3246, Feb. 1996. Geomatics Department, University of Calgary, Canada. His current research
[23] M. Håkansson, A. B. O. Jensen, M. Horemuz, and G. Hedling, “Review interests include high-precision GNSS positioning and integrated navigation
of code and phase biases in multi-GNSS positioning,” GPS Solutions, systems.
vol. 21, no. 3, pp. 849–860, Jul. 2017.
[24] A. Brandt and J. F. Gardner, “Constrained navigation algorithms for Aboelmagd Noureldin (Senior Member, IEEE)
strapdown inertial navigation systems with reduced set of sensors,” received the B.Sc. degree in electrical engineering
in Proc. Amer. Control Conf. (ACC), Philadelphia, PA, USA, vol. 3, and the M.Sc. degree in engineering physics from
Jun. 1998, pp. 1848–1852. Cairo University, Egypt, in 1993 and 1997, respec-
[25] X. Niu, S. Nasser, C. Goodall, and N. El-Sheimy, “A universal approach tively, and the Ph.D. degree in electrical and com-
for processing any MEMS inertial sensor configuration for land-vehicle puter engineering from the University of Calgary,
navigation,” J. Navigat., vol. 60, no. 2, pp. 233–245, May 2007. AB, Canada, in 2002.
[26] B. Phuyal, “An experiment for a 2-D and 3-D GPS/INS configuration He is currently a Professor with the Depart-
for land vehicle applications,” in Proc. Position Location Navigat. Symp. ment of Electrical and Computer Engineering, Royal
(PLANS), Monterey, CA, USA, Apr. 2004, pp. 148–152. Military College of Canada (RMCC) with Cross-
[27] P. Daum, J. Beyer, and T. F. W. Kohler, “Aided inertial LAnd NAvigation Appointment at the School of Computing and the
system (ILANA) with a minimum set of inertial sensors,” in Proc. IEEE Department of Electrical and Computer Engineering, Queen’s University. He
Position, Location Navigat. Symp. (PLANS), Las Vegas, NV, USA: IEEE, is also the Founder and the Director of the Navigation and Instrumentation
Apr. 1994, pp. 284–291. Research Group, RMCC. He has published two books, four book chapters,
and more than 270 papers in journals, magazines, and conference proceedings.
[28] D. Sun, M. G. Petovello, and M. E. Cannon, “GPS/Reduced IMU
His research interests include global navigation satellite systems, wireless
with a local terrain predictor in land vehicle navigation,” Int. J. Nav-
location and navigation, indoor positioning and multi-sensor fusion targeting
igat. Observ., vol. 2008, pp. 1–15, Nov. 2008. [Online]. Available:
applications related to autonomous systems, intelligent transportation, road
https://www.hindawi.com/journals/ijno/2008/813821/
information services, crowd management, and the vehicular Internet of Things.
[29] U. Iqbal, A. F. Okou, and A. Noureldin, “An integrated reduced His research work led to 13 patents and several technologies licensed to
inertial sensor system—RISS/GPS for land vehicle,” in Proc. IEEE/ION industry in the area of position, location, and navigation systems.
Position, Location Navigat. Symp., Monterey, CA, USA, May 2008,
pp. 1014–1021. Michael Korenberg received the B.Sc. and M.Sc.
[30] A. Noureldin, T. B. Karamat, and J. Georgy, Fundamentals of Inertial degrees in mathematics and the Ph.D. degree in elec-
Navigation, Satellite-Based Positioning and Their Integration. Berlin, trical engineering from McGill University, Montreal,
Germany: Springer-Verlag, 2013. QC, Canada.
[31] M. M. Atia, T. Karamat, and A. Noureldin, “An enhanced 3D multi- He has been a Faculty Member with Queen’s
sensor integrated navigation system for land-vehicles,” J. Navigat., University since 1983, where he is currently a Pro-
vol. 67, no. 4, pp. 651–671, Jul. 2014. fessor with the Department of Electrical and Com-
[32] Z. M. Kassas and T. E. Humphreys, “Observability analysis of collabo- puter Engineering. His research interests include
rative opportunistic navigation with pseudorange measurements,” IEEE the development of practical methods for represent-
Trans. Intell. Transp. Syst., vol. 15, no. 1, pp. 260–273, Feb. 2014. ing/identifying nonlinear systems of unknown struc-
[33] Z. M. Kassas, “Navigation with cellular signals,” in Position, Navigation, ture and for time-series analysis. Applications relate
and Timing Technologies in the 21st Century: Integrated Satellite to communications, to the modeling of physical and physiological processes,
Navigation, Sensor Systems, and Civil Applications, vol. 2, Y. J. Morton, and to computational biology and bioinformatics. The latter applications
F. van Diggelen, J. J. Spilker Jr., and B. W. Parkinson, Eds. Hoboken, include protein sequence classification, gene recognition, and interpretation
NJ, USA: Wiley, Jan. 2021. of microarray data.
Authorized licensed use limited to: TONGJI UNIVERSITY. Downloaded on June 11,2021 at 05:24:11 UTC from IEEE Xplore. Restrictions apply.