[go: up one dir, main page]

Next Article in Journal
Feasibility Study for Monitoring an Ultrasonic System Using Structurally Integrated Piezoceramics
Next Article in Special Issue
Frequency Instability Impact of Low-Cost SDRs on Doppler-Based Localization Accuracy
Previous Article in Journal
Enhancing Security and Flexibility in the Industrial Internet of Things: Blockchain-Based Data Sharing and Privacy Protection
Previous Article in Special Issue
InertialNet: Inertial Measurement Learning for Simultaneous Localization and Mapping
 
 
Font Type:
Arial Georgia Verdana
Font Size:
Aa Aa Aa
Line Spacing:
Column Width:
Background:
Article

Improving Vehicle Heading Angle Accuracy Based on Dual-Antenna GNSS/INS/Barometer Integration Using Adaptive Kalman Filter

1
School of Technology, Beijing Forestry University, Beijing 100083, China
2
School of Information and Communication Engineering, Beijing University of Posts and Telecommunications, Beijing 100876, China
3
Institute of Space Science and Applied Technology, Harbin Institute of Technology, Shenzhen 518055, China
*
Authors to whom correspondence should be addressed.
Sensors 2024, 24(3), 1034; https://doi.org/10.3390/s24031034
Submission received: 10 January 2024 / Revised: 1 February 2024 / Accepted: 2 February 2024 / Published: 5 February 2024
(This article belongs to the Special Issue Advanced Inertial Sensors, Navigation, and Fusion)
Figure 1
<p>The architecture of the dual-antenna GNSS/INS/Barometer integrated navigation system. <math display="inline"><semantics> <mrow> <msub> <mo>∗</mo> <mi>G</mi> </msub> </mrow> </semantics></math> represents values measured by GNSS. <math display="inline"><semantics> <mi>δ</mi> </semantics></math> represents the error value.</p> ">
Figure 2
<p>Diagram of the coordinate systems.</p> ">
Figure 3
<p>The experiment vehicle.</p> ">
Figure 4
<p>Acquisition of experimental data in the open and occluded environment: (<b>a</b>) Experiment with real-time scenario in the playground; (<b>b</b>) Test vehicle through the building tunnel; (<b>c</b>) Test vehicle trajectory in the open environment; (<b>d</b>) Test vehicle trajectory in the occluded environment.</p> ">
Figure 5
<p>HDOP during the open and occluded environment experiment: (<b>a</b>) The value of HDOP during the open environment experiment; (<b>b</b>) The value of HDOP during the occluded environment experiment.</p> ">
Figure 6
<p>Acquisition of original IMU data in the open and occluded environments: (<b>a</b>) Original triaxial accelerometer data in the playground; (<b>b</b>) Original triaxial gyroscope data in the playground; (<b>c</b>) Original triaxial accelerometer data in the occluded environment; (<b>d</b>) Original triaxial gyroscope data in the occluded environment.</p> ">
Figure 7
<p>The estimation of heading angle during the open and occluded environment experiments: (<b>a</b>) The estimation of heading angle in the open environment; (<b>b</b>) The estimation of heading angle in the occluded environment.</p> ">
Versions Notes

Abstract

:
High-accuracy heading angle is significant for estimating autonomous vehicle attitude. By integrating GNSS (Global Navigation Satellite System) dual antennas, INS (Inertial Navigation System), and a barometer, a GNSS/INS/Barometer fusion method is proposed to improve vehicle heading angle accuracy. An adaptive Kalman filter (AKF) is designed to fuse the INS error and the GNSS measurement. A random sample consensus (RANSAC) method is proposed to improve the initial heading angle accuracy applied to the INS update. The GNSS heading angle obtained by a dual-antenna orientation algorithm is additionally augmented to the measurement variable. Furthermore, the kinematic constraint of zero velocity in the lateral and vertical directions of vehicle movement is used to enhance the accuracy of the measurement model. The heading errors in the open and occluded environment are 0.5418° (RMS) and 0.636° (RMS), which represent reductions of 37.62% and 47.37% compared to the extended Kalman filter (EKF) method, respectively. The experimental results demonstrate that the proposed method effectively improves the vehicle heading angle accuracy.

1. Introduction

With the advancement of vehicle intelligence, real-time attitude based on available measurements plays a vital role in reliable path planning, decision making, and controls in autonomous vehicles [1]. Considering the actual conditions of the vehicle in motion, the estimation of vehicle attitude is mainly determined by the accuracy of the heading angle [2]. A variety of sensors can be utilized to measure the heading angle, such as GNSS (Global Navigation Satellite System), INS (Inertial Navigation System), magnetometers, vision sensors, laser radar, wireless signals, and so on [3,4,5,6,7,8,9,10,11]. In the above-mentioned methods, the integration of GNSS/INS is one of the most common approaches in the field of automotives [12].
However, some essential state variables, such as heading (error), are not well observed in some specific driving scenarios while fusing GNSS and INS data [13]. For a low-cost inertial measurement unit (IMU), this phenomenon is even more pronounced [14]. Therefore, in order to improve the accuracy of the heading angle and increase the robustness of the system, it is necessary to add other sensors and adopt innovative algorithms.
GNSS velocity measurements can be accurate because a GNSS receiver determines velocity based on the Doppler shift of GNSS carrier waves or by differencing consecutive GNSS carrier wave measurements [15]. Therefore, two GNSS receivers were utilized to measure the velocity of a vehicle and calculate the vehicle heading angle based on kinematic relationships [16]. At the same time, increasing the number of GNSS receivers results in an increase in costs. As technology evolves, dual-antenna GNSS receivers, utilizing baseline orientation to determine heading angles, are widely applied for integration with an IMU [17,18]. A wheel speed sensor (WSS) is another option to replace the second GNSS receiver because it can measure the speed of individual wheels. But velocities from WSSs need to be converted to the local navigation frame (n-frame) with the aid of an IMU [19]. It is also practical to use a magnetometer as an additional sensor to measure the heading angle. To reject the magnetic disturbances from other components, a new stochastic filter was designed and integrated into a Kalman filter framework [20]. To suppress the divergence of the heading angle, an effective approach is the kinematic model-based method, which is a simple vehicle model that correlates the vehicle’s longitudinal and lateral velocities with longitudinal and lateral accelerations and the heading rate [21]. A steering constraint based on a kinematic model was designed to enhance the heading angle estimation accuracy of land vehicles [22]. However, this method is only applicable to stationary or low-speed states. Inspired by vehicle kinematics, a novel method of heading angle estimation based on Zero-Heading angle-Variation-Constraint and Sequential-Adaptive Unscented Kalman Filter algorithms is proposed for solving the problem of heading angle unobservability and the instability of the filtering [23]. Owing to the presence of heading angular outputs from dual-antenna GNSS and INS systems, the mounting angle errors will reduce the heading angle accuracy [24]. GNSS antennas usually have a regular shape, and the mounting angle can be measured using optical methods. But this method requires specialized equipment to be prepared in advance. Heading angle misalignment between a dual-antenna GNSS and a vehicle frame was also estimated using a robust regression method [13]. The influence of random noise and outliers was effectively suppressed through this algorithm in the heading angle measurement. For mounting angle errors between the IMU frame and the vehicle frame, the dead reckoning method in a straightforward Kalman filter was a conventional and proven method. But formal experiments require a period of time for filter convergence [25,26]. A novel model was proposed to associate the INS heading angle error with the position and velocity by a lever arm [27]. However, experimental validation was set up only for large angular errors. To address smaller error angles, an error-state Kalman filter using vehicle velocity and non-holonomic constraints was developed to estimate IMU mounting angles [28].
Inspired by [18], a dual-antenna GNSS receiver is added to this study to improve the vehicle heading angle accuracy and supply the initial heading. The barometer that calculates elevation changes by obtaining the difference in air pressure values at different locations is one of the common sensors in consumer-grade devices. However, integrated GNSS/INS/Barometer navigation in vehicles has been under-explored. Based upon the foregoing, the main contributions of this study are summarized as follows:
  • A random sample consensus (RANSAC) method is applied to improve the initial heading angle accuracy and to ensure the initial attitude accuracy of the INS.
  • GNSS heading angle obtained by a dual-antenna orientation algorithm is added as a measurement variable in the integrated navigation system based on an adaptive Kalman filter (AKF) in addition to position and velocity. Furthermore, velocity and position errors caused by the lever arm are corrected. The kinematic constraint of zero velocity in the lateral and vertical directions of vehicle movement is used to enhance the accuracy of the measurement model.
  • A barometer is added to the traditional GNSS/INS integrated navigation system to enhance the reliability of the system. When none of the GNSS receiver data are available, the barometer and INS data are used to ensure a short-time accuracy.
The remainder of this paper is organized as follows: The Section 2 describes the basic concepts, the dual-antenna orientation algorithm, and the fusion process using AKF. The Section 3 introduces the experimental platform and analyzes the error of the experimental results in the open and occluded environment. The Section 4 summarizes this work.

2. Methodology Design

The architecture of the GNSS/INS/Barometer integration is illustrated in Figure 1. ω i b b represents the angular velocity of the IMU body with respect to inertial space in IMU body axes measured by the gyroscopes. f i b b represents the specific force of the IMU body with respect to inertial space in the IMU. v n and p n are the three-dimensional velocity and position. ψ and h represent the heading angle and elevation.
To ensure the accuracy of the vehicle heading angle output by the proposed algorithm, the heading angle mounting error is corrected by an error-state Kalman filter using kinematic constraints. Due to the rectangular body of the intelligent automobile and the presence of the antenna-limiting holes, the calibration of the GNSS antenna can be performed with millimeter accuracy using a scale at the time of installation.

2.1. Reference Coordinate System for Integrated Navigation System

Integrated navigation requires a set of unified coordinate systems to accurately represent the state of the vehicle. The common coordinate systems are Earth-Centered Earth-Fixed (e-frame), local navigation frame (n-frame), and body frame (b-frame). In the n-frame, the x-axis, y-axis, and z-axis point east, north, and up, respectively. The b-frame is the right-handed 3D Cartesian frame rigidly connected to the vehicle with the x-axis, y-axis, and z-axis in the vehicle’s right, front, and up directions, respectively. The diagram of the coordinate system is shown in Figure 2.
To establish the connection between the n-frame and b-frame, three Euler angles (roll, pitch, and heading) are used to construct the coordinate transformation matrix. In the n-frame, the matrix C n b is obtained by rotating the z-x-y axes (heading–pitch–roll) sequentially. The coordinate transformation matrix C n b is expressed as
C n b = [ cos ϕ cos ψ sin γ sin θ sin ψ cos ϕ sin ψ + sin γ sin θ cos ψ sin ϕ cos θ cos θ sin ψ cos θ cos ψ sin θ sin ϕ cos ψ + cos γ sin θ sin ψ sin ϕ sin ψ cos ϕ sin θ cos ψ cos ϕ cos θ ]
where ϕ , θ , and ψ are the roll, pitch, and heading angles, respectively.

2.2. INS Error-State Model Development

2.2.1. RANSAC Algorithm

For consumer-grade IMUs, initial alignment does not obtain a heading angle. Therefore, an accurate initial heading angle from the GNSS is critical for attitude updates.
The initial heading angle is modeled as
ψ i n i t i a l _ G = ψ i n i t i a l + χ
where ψ i n i t i a l _ G is measured by GNSS, ψ i n i t i a l is the true value, and χ represents measurement noise.
A RANSAC method is applied to estimate ψ i n i t i a l . To tackle the abnormal values in GNSS measurements, all data are divided into inliers and outliers based on a threshold ε [29]:
ψ i n i t i a l _ G = { inliers d ε o u t l i e r s d > ε
where d means the distance from the point to the line formed by the chosen two points.
After iteration, the model containing the most inliers is chosen as the true value model.

2.2.2. INS Error-State Model

According to the mechanical choreography of inertial navigation, the non-linear error model is linearized. The error model can be expressed as [30]
α ˙ = ω i n n × α + δ ω i n n C b n δ ω i b b
δ v ˙ n = f n × α ( 2 δ ω i e n + δ ω e n n ) × v n ( 2 ω i e n + ω e n n ) × δ v n + δ f n + δ g n
δ p ˙ n = M p v δ v n + M p p δ p n
where α is the misalignment angle and α = [ δ ϕ δ θ δ ψ ] T , δ v n is the velocity error in the n-frame, δ v n = [ δ v E n δ v N n δ v U n ] T , δ p n is the position error, and δ p n = [ δ L δ λ δ h ] T . M p v (1,2) = 1 R M + h , M p v (2,1) = sec L ( R N + h ) , M p v (3,3) = 1, M p p (1,3) = V N ( R M + h ) 2 , M p p (2,1) = V E sec L tan L ( R N + h ) , M p p (2,3) = V E sec L ( R N + h ) 2 , and the other elements in the M p v 3 × 3 and M p p 3 × 3 are zero.
Generally, the gyro constant drift ε b and accelerometer constant bias b are described by random constants as follows [12]:
δ ε ˙ i b = 0   ( i = x , y , z )
δ ˙ i b = 0   ( i = x , y , z )
The system-state vector of the INS/GNSS integrated system is defined as
x ( t ) = [ α E α N α U δ v E n δ v N n δ v U n δ L δ λ δ h ε x b ε y b ε z b x b y b z b ] T
The low-cost IMU in this work cannot measure the rotation rate of the Earth due to its insufficient accuracy. Moreover, the error caused by the change in g is minimal. Based on the chosen system state and the above-mentioned reasons, we can obtain the error-state equation through combining (4)–(9) [18]
x ˙ ( t ) = F ( t ) x ( t ) + G ( t ) w ( t )
F ( t ) = [ ω i n n × 3 × 3 F 12 3 × 3 F 13 3 × 3 C b 3 × 3 n 0 3 × 3 f n × 3 × 3 F 22 3 × 3 F 23 3 × 3 0 3 × 3 C b 3 × 3 n 0 3 × 3 F 32 3 × 3 F 33 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 ] 15 × 15
G ( t ) = [ C b 3 × 3 n 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 C b 3 × 3 n 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 ] 15 × 15
w ( t ) = [ n g x b n g y b n g z b n a x b n a x b n a x b 0 0 0 0 0 0 0 0 0 ] T
where ω i n n × and f n × denote the 3 × 3 skew–symmetric matrix of ω i n n and f n . F 12 (1,2) = 1 R M + h , F 12 (2,1) = 1 R N + h , F 12 (3,1) = tan L ( R N + h ) , F 13 (1,3) = v N n ( R M + h ) 2 , F 13 (2,3) = v E n ( R N + h ) 2 , F 13 (3,1) = v E n ( sec L ) 2 R N + h , F 13 (3,3) = v E n tan L ( R N + h ) 2 , F 22 (1,1) = tan L R N + h v N n 1 R N + h v U n , F 22 (1,2) = tan L R N + h v E n , F 22 (1,3) = 1 R N + h v E n , F 22 (2,1) = 2 tan L R N + h v E n , F 22 (2,2) = 1 R M + h v U n , F 22 (2,3) = 1 R M + h v N n , F 22 (3,1) = 2 1 R N + h v E n , F 22 (3,2) = 2 1 R M + h v N n , F 23 (1,1) = ( sec L ) 2 R N + h v E n v N n , F 23 (1,3) = 1 ( R N + h ) 2 v E n v U n tan L ( R N + h ) 2 v E n v N n , F 23 (2,1) = ( sec L ) 2 R N + h ( v E n ) 2 , F 23 (2,3) = 1 ( R M + h ) 2 v N n v U n + tan L ( R N + h ) 2 ( v E n ) 2 , F 23 (3,3) = 1 ( R M + h ) 2 ( v N n ) 2 1 ( R N + h ) 2 ( v E n ) 2 , and the other elements in the F 12 , F 13 , F 22 and F 23 are zero. F 32 = M p v , F 33 = M p p . L represents the latitude. n g b and n a b represent the Gaussian white noise of the gyroscope and accelerometer in the b-frame.

2.3. Dual-Antenna Orientation Algorithm

The dual-antenna GNSS receiver defines the vehicle heading by calculating the baseline orientation. Thus, the primary aim of the algorithm is to form the baseline vectors by difference. For satellite i in Figure 2, the distance equations using the carrier wave can be expressed as [15]
λ φ m a i n i = r m a i n i + c ( ( d t u ) m a i n i ( d t s ) m a i n i ) + λ N m a i n i + ( d ion ) m a i n i + ( d t r o p m a i n i + ( ε m u l t ) m a i n i
λ φ s l a v e i = r s l a v e i + c ( ( d t u ) s l a v e i ( d t s ) s l a v e i ) + λ N s l a v e i + ( d ion ) s l a v e i + ( d t r o p ) s l a v e i + ( ε m u l t ) s l a v e i
where λ represents the wavelength of the carrier, φ represents the phase difference, r represents the geometric distance between the satellite and the antenna, c is the speed of light, d t u and d t s represent receiver clock error and satellite clock error, N represents integer ambiguity, d ion and d trop represent ionospheric and tropospheric errors, and ε m u l t represents multipath error.
Then, through two differential operations, the double difference equation can be obtained as
λ Δ φ m a i n , s l a v e i j = Δ r m a i n , s l a v e i j + λ Δ N m a i n , s l a v e i j
A transformation of the equation gives
λ Δ φ m a i n , s l a v e i j = ( l r i l r j ) · b m a i n , s l a v e + λ Δ N m a i n , s l a v e i j
where l r represents the identity direction vector between the antenna and the satellite, b m a i n , s l a v e represents the baseline vector, and Δ represents the double difference operator.
The Least-squares Ambiguity Decorrelation Adjustment (LAMBDA) algorithm is utilized to solve for integer ambiguity [31]. The least squares method is used to obtain the baseline vector.

2.4. Measurement Model

2.4.1. Initial Measurement Model

In order to develop the measurement model, the heading angle, velocity, and position from the GNSS receiver are imported into the measurement error equation. The measurement model can be expressed as
[ ψ I ψ G v I n v G n p I n p G n ] = [ 1 1 × 1 0 1 × 1 0 1 × 1 0 3 × 3 I 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 I 3 × 3 ] [ δ ψ I δ v I n δ p I n ] + [ δ ψ G δ v G n δ p G n ]
where ψ G , v G n and p G n are measured by GNSS, and ψ I , v I n and p I n are measured by INS.

2.4.2. The Lever Arm Correction Algorithm

Since the origin of the measured position and velocity by GNSS is located at the phase center of the main antenna and the origin of the INS measurements is located at the IMU, the spatial distance between the main antenna and the IMU (referred to as the lever arm) should be taken into account.
The IMU is located at the b-frame origin; GNSS velocity can be corrected by [32]
v G n = v G n C b n ( ω e b b × δ l b )
where v G n is the velocity at the origin of the n-frame, v G n is the velocity prior to correction, ω e b b is approximately equal to ω i b b because ω e b b = ω i b b ω i e b and the value of ω i e b is minimal, δ l b is the spatial distance of the main antenna from the IMU, and δ l b = [ 0 B 2 0 ] T (the placement can be seen in Figure 2).
The GNSS position can be corrected by [32]
p G n = p G n M p v C b n δ l b
where p G n is the position at the origin of the n-frame, and p G n is the position prior to correction.

2.4.3. Corrected Measurement Model Using the Kinematic Constraint

Considering the actual conditions of the vehicle in motion, the vehicle is moving normally without skidding and jumping. The kinematic constraint, which refers to zero velocity in the lateral and vertical directions of vehicle movement, is utilized to improve the accuracy of the measurement model:
v G n = [ v x n v y n v z n ] = [ 0 v y n 0 ]
Using the corrected GNSS data, the measurement equation can eventually be expressed as
Z ( t ) = H ( t ) x ( t ) + υ ( t )
Z ( t ) = [ ( ψ I ψ G ) 1 × 1 ( v I n v G n ) 3 × 1 ( p I n p G n ) 3 × 1 ] T 7 × 1
H ( t ) = [ H 11 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 I 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 I 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 ] 15 × 15
where H 11 (3,3) = 1, and the other elements in the H 11 are zero.
υ ( t ) = [ δ ψ G δ v G n δ p G n ] T
where δ ψ G , δ v G n , and δ p G n are the measurement noises, which correspond to the one-dimensional heading error, three-dimensional velocity error vector, and three-dimensional position error vector of the GNSS receiver, respectively.

2.4.4. Corrected Measurement Model for Special Scenarios

When the GNSS receiver can fix positions but the dual-antenna orientation algorithm fails, the measurement model can be changed to
Z ( t ) = [ ( v I n v G n ) 3 × 1 ( p I n p G n ) 3 × 1 ] T 6 × 1
H ( t ) = [ 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 I 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 I 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 0 3 × 3 ] 15 × 15
When the GNSS does not receive the signal and cannot fix positions, none of the GNSS receiver data are available, so the barometer and INS data are used to ensure short-time accuracy.
The barometer/INS measurement model can be expressed as
Z ( t ) = H ( t ) x ( t ) + υ ( t )
Z ( t ) = [ h I n h B n ] T 1 × 1
where H 15 × 15 (6,6) = 1, and the other elements in the H 15 × 15 are zero. υ ( t ) indicates barometer measurement noise.

2.5. AKF Design

Based on the models developed in Section 2.2 and Section 2.4, an AKF is designed for sensor data fusion. The discretization of a linearized system in continuous time leads to [33]
{ x ( k ) = Φ k / k 1 x ( k 1 ) + G k / k 1 W ( k 1 ) Z ( k ) = H ( k ) x ( k ) + V ( k )
where Φ k / k 1 I + F ( t k 1 ) T s , T s is the discrete interval time.
The state equation corresponds to Equations (10)–(12). The measurement equation contains three cases, corresponding to Equations (22)–(24), (26), (27), and (28), (29), respectively.
AKF update is mainly divided into two parts: prediction and correction. The prediction part is divided into one-step state prediction and MSE (mean square error) matrix prediction. The formulas are as follows [34]:
x ^ k / k 1 = Φ k / k 1 x ^ k 1
P k / k 1 = Φ k / k 1 P k 1 Φ k / k 1 T + G k 1 Q k 1 G k 1 T
The prediction residual is defined by
V ^ k = Z k H k x ^ k / k 1
The prediction residual is constructed by a two-segment adaptive factor [35]:
α k = { 1 | V ˜ k | c c | V ˜ k | | V ˜ k | > c
where α k is the adaptive factor, V ˜ k = V ^ k / t r a c e ( P V ^ k ) , P V ^ k is the prediction residual covariance matrix, P V ^ k = H k P k , k 1 H k + R k . * , and t r a c e ( ) represents the least-squares norm and the trace of the matrix, respectively. c is the empirical threshold.
In the correction part, Kalman gain is calculated first, followed by state estimation and MSE matrix estimation. The formulas are as follows.
K k = 1 α k P k / k 1 H k T ( 1 α k H k P k / k 1 H k T + R ) 1
x ^ k = x ^ k / k 1 + K k ( Z k H k x ^ k / k 1 )
P k = 1 α k ( I K k H k ) P k / k 1

3. Experiment and Discussion

3.1. Experiment Platform

Figure 3 shows the experimental vehicle platform equipped with an integrated navigation receiver (UMPOLA V18D, UniStrong, Beijing, China) consisting of a GNSS receiver, an IMU module, and a barometer. The characteristics of the three modules are listed in Table 1. In order to obtain data from the different modules at the same time, all information is collected using NAVITEST engineering software version 1.0.0.1 and stored on the PC.
The positioning antenna (master antenna) is located at the rear limit hole of the vehicle and the directional antenna (slave antenna) is located at the front limit hole. The two antennas are 1.0 m apart.

3.2. Heading Angle Experiment and Discussion

3.2.1. Open and Occluded Environment Experiment

The playground of Beijing Forestry University has both straight and curved paths and is not obstructed by tall buildings and trees, so it can intuitively and clearly reflect the performance of the proposed algorithm. The open environment experimental data were obtained by the vehicle traveling one lap counterclockwise around the fifth track of the playground. Considering the inevitability of the occlusion problem, the occluded environment experiments at the east campus were added to the heading angle estimation experiments. The trajectory of the occluded environment experiment included sharp curves, a ninety-degree turn, and a straight line, and these roads verified the sensitivity of the algorithm. The experimental scenario and trajectory of the open and occluded environment are depicted in Figure 4.
In order to clearly characterize the degree of obscuration, horizontal dilution of precision (HDOP) was introduced into the experiment. As shown in Figure 5a, the HDOP values were below 1 throughout the experiment, which means that the GNSS signal was good. The value of HDOP exhibits significant fluctuations in Figure 5b. At 85–100 s, the vehicle drove into the building tunnel (Figure 4b); at this time, the GNSS signal was completely obstructed and the GNSS receiver did not work properly.
As shown in Figure 6a,b, the maximum lateral acceleration and angular rate reached 3.33 m/s2 and 19.21°/s in the open environment experiment. The acceleration and angular rate produced even more dramatic fluctuations, as shown in Figure 6c,d, where the peak of the angular rate exceeded 35°/s. This result is highly compatible with the route of the occluded environment experiment.

3.2.2. Experimental Results and Discussion

The heading angle estimations for the open and occluded environment experiments are illustrated in Figure 7. The reference data are the result of using the original filtering algorithm of the integrated navigation receiver. The accuracy of the reference heading angle data is 0.05° at the one-meter baseline, which is better than the accuracy of the GNSS orientation algorithm.
In Figure 7a, the start and end heading angle of the test vehicle varied by more than 360°. The extended Kalman filter (EKF) method was selected as the comparison method and the measurement variables of the EKF method were three-dimensional velocity and position. As can be seen from the two local magnifications, the curves of the AKF method are more identical to the reference curve than that of the EKF method, regardless of whether the GNSS heading angle is utilized as a measurement variable or not. When heading angle is used as a measurement variable, the results of the AKF with heading angle method are significantly closer to the reference value than those of the AKF without heading angle method.
The results of the heading angle comparison using the different methods are presented in Figure 7b. The results of the 200-s experiment were divided into three parts: 0–85 s for part 1, 85–189 s for part 2, and 189–200 s for part 3. In part 2, the time period of the GNSS heading angle anomaly diverges from the results of HDOP in Figure 5b. HDOP was zero from 85 s to 100 s, which means that the GNSS receiver could not fix the position. At this point, the only measurement variable was the elevation data from the barometer. The results of the proposed method maintain better accuracy than the comparison method. At the moment of the 100th second, the value of HDOP changed abruptly from 0 to 3.36 and the positioning function was restored. The GNSS heading angle did not return to normal until the 189th second, as the dual-antenna orientation algorithm failed. The measurement variables of the AKF method are three-dimensional velocity and position. Due to the GNSS heading angle abnormality in the whole of part 2, the measurement variables of the proposed method did not include the GNSS heading angle. Successful experimental results using the AKF method were presented in situations with both complete and partial occlusion. As shown in the two enlargements, after integration with the high-frequency INS, the estimated heading by the AKF method was smoother than that of the original GNSS heading. The AKF curve has less error compared to the curve of the EKF method.
In order to analyze the results accurately, Table 2 exhibits specific error indicators throughout the experimental period. The values of MAE, STD, and RMS represent the overall level of error, which mainly depends on the environment and the algorithm. By comparing different scenarios, it is revealed that the errors in the open environment are overall better than the errors in the occluded environment. In both scenarios, the minimum error values were obtained by the AKF method, which means that the proposed method has the best accuracy. The value of MAX appeared at a certain moment and showed the instantaneous error of the applied methodology. In the open scenario, the maximum errors of the EKF and AKF without heading angle methods occurred at 325.2 and 326.9 s, respectively. As depicted in Figure 7a, these two moments are just after the peak, which was formed by the sudden lateral acceleration from the operator. Therefore, the value of MAX can also be affected by human manipulation in addition to the environment and algorithm.
For the errors in the open environment, the four indicators of the heading angle error of the two AKF methods are all better than the error value of the EKF method. MAE, MAX, and STD decreased by 30.49%, 81.99%, and 61.60%, respectively, compared to the error of the EKF method. In AKF with heading angle, RMS, which is the most commonly used index for evaluating navigation accuracy, was also 37.62% less than the value of RMS in the EKF method. This reduction proves that the algorithm of the AKF with heading angle method improved the heading angle accuracies in the open environment.
In the occluded environment, a significant increase in the GNSS heading angle error occurred due to severe obstruction of the GNSS signals. But the errors of heading obtained by the AKF method maintained a high level of accuracy. Compared to the error values of the EKF method, the four error values of the AKF method are 0.5048° (MAE), 2.9052° (MAX), 0.5098° (STD), and 0.6367° (RMS) in turn, which represent 35.24%, 58.37%, 57.07%, and 47.37%. The error fluctuations caused by environment occlusion were effectively suppressed by the AKF method.
Based on the aforementioned discussion, the accuracy of the heading angle was effectively improved by the AKF algorithm proposed in this study. Additionally, the GNSS/INS/Barometer integration using AKF with heading angle has better stability and robustness than the EKF method.
The experimental results also demonstrate that the open environment without the occlusion of buildings and trees is the primary condition for the proposed algorithm to reduce the error. Although the sensitivity of the proposed algorithm is better than the comparative methods, a slight hysteresis still exists. As shown in Figure 7, the reaction rate of the proposed algorithm is still slightly slower than the reference results when the vehicle’s heading is rapidly changed by the operator. If the test vehicle is required to travel in a straight line, reducing the lateral acceleration contributes to decreasing the sharp increase in errors.

4. Conclusions

A dual-antenna GNSS receiver was added to this study to improve the vehicle heading angle accuracy. A RANSAC method was proposed to improve the initial heading angle accuracy. By using the dual-antenna orientation algorithm, GNSS heading angle was added as a measurement variable in the integrated navigation system based on AKF in addition to three-dimensional position and velocity. Moreover, velocity and position were corrected by the lever arm correction algorithm. The kinematic constraint, which refers to zero velocity in the lateral and vertical directions of vehicle movement, was utilized to enhance the accuracy of the measurement model. When none of the GNSS receiver data were available, a barometer was added to the traditional GNSS/INS integrated navigation system to enhance the reliability of the system. INS data and the barometer instead of GNSS were used to ensure short-time accuracy. Through the fusion of the INS error equation with the measurement equation, a dual-antenna GNSS/Barometer/INS integration based on AKF was created.
The proposed dual-antenna GNSS/INS/Barometer integration using the AKF algorithm was validated in open and occluded environments. In the open environment, the heading angle accuracy of the AKF with heading angle method was 0.4435° (MAE), 1.1489° (MAX), 0.3264° (STD), and 0.5418° (RMS), which represent reductions of 30.49%, 81.99%, 61.60%, and 37.62% compared to the EKF method, respectively. In the occluded environment, the AKF algorithm maintained a high level of heading accuracy. The heading angle accuracy of the proposed method was 0.636° (RMS), which is 47.37% less than the error of the EKF method. The experimental results indicate that the proposed dual-antenna GNSS/Barometer/INS integration based on the AKF method effectively improves the vehicle heading angle accuracy, and the error values are also superior to those of the EKF method in both open and occluded environments.
Due to time constraints, the number of comparison methods was limited. Therefore, future work should be dedicated to researching new data fusion methods. Improving sensitivity is one of the targets of the algorithms when the vehicle heading changes rapidly. Non-linear filters should also be a focus of study.

Author Contributions

Conceptualization, X.X. and S.C.; methodology, H.J. and N.G.; software, H.J.; validation, X.X., H.J. and Z.Y.; formal analysis, S.C. and N.G.; investigation, X.X.; resources, S.C.; data curation, X.X.; writing—original draft preparation, H.J.; writing—review and editing, S.C.; visualization, Z.Y.; supervision, X.X.; project administration, N.G.; funding acquisition, X.X., Z.Y. and N.G. All authors have read and agreed to the published version of the manuscript.

Funding

This research was funded by the Key-Area Research and Development Program of Guangdong Province 2020B0303020001 and the National Natural Science Foundation of China under Grant 32371868 and 6210020653.

Institutional Review Board Statement

Not applicable.

Informed Consent Statement

Not applicable.

Data Availability Statement

Data are contained within the article.

Conflicts of Interest

The authors declare no conflicts of interest.

References

  1. Chen, L.; Zheng, F.; Gong, X.; Jiang, X. GNSS High-Precision Augmentation for Autonomous Vehicles: Requirements, Solution, and Technical Challenges. Remote Sens. 2023, 15, 1623. [Google Scholar] [CrossRef]
  2. Xia, X.; Hashemi, E.; Xiong, L.; Khajepour, A.; Xu, N. Autonomous Vehicles Sideslip Angle Estimation: Single Antenna GNSS/IMU Fusion With Observability Analysis. IEEE Internet Things J. 2021, 8, 14845–14859. [Google Scholar] [CrossRef]
  3. Ding, X.; Wang, Z.; Zhang, L.; Wang, C. Longitudinal Vehicle Speed Estimation for Four-Wheel-Independently-Actuated Electric Vehicles Based on Multi-Sensor Fusion. IEEE Trans. Veh. Technol. 2020, 69, 12797–12806. [Google Scholar] [CrossRef]
  4. Yang, H.; Hong, J.; Wei, L.; Gong, X.; Xu, X. Collaborative Accurate Vehicle Positioning Based on Global Navigation Satellite System and Vehicle Network Communication. Electronics 2022, 11, 3247. [Google Scholar] [CrossRef]
  5. Oh, J.; Choi, S.B. Vehicle Roll and Pitch Angle Estimation Using a Cost-Effective Six-Dimensional Inertial Measurement Unit. Proc. Inst. Mech. Eng. Part D J. Automob. Eng. 2013, 227, 577–590. [Google Scholar] [CrossRef]
  6. Li, Y.; Zahran, S.; Zhuang, Y.; Gao, Z.; Luo, Y.; He, Z.; Pei, L.; Chen, R.; El-Sheimy, N. IMU/Magnetometer/Barometer/Mass-Flow Sensor Integrated Indoor Quadrotor UAV Localization with Robust Velocity Updates. Remote Sens. 2019, 11, 838. [Google Scholar] [CrossRef]
  7. Shahian Jahromi, B.; Tulabandhula, T.; Cetin, S. Real-Time Hybrid Multi-Sensor Fusion Framework for Perception in Autonomous Vehicles. Sensors 2019, 19, 4357. [Google Scholar] [CrossRef] [PubMed]
  8. Yue, Z.; Lian, B.; Tang, C.; Tong, K. A Novel Adaptive Federated Filter for GNSS/INS/VO Integrated Navigation System. Meas. Sci. Technol. 2020, 31, 085102. [Google Scholar] [CrossRef]
  9. Song, Y.; Nuske, S.; Scherer, S. A Multi-Sensor Fusion MAV State Estimation from Long-Range Stereo, IMU, GPS and Barometric Sensors. Sensors 2016, 17, 11. [Google Scholar] [CrossRef]
  10. Khaghani, M.; Skaloud, J. Assessment of VDM-Based Autonomous Navigation of a UAV under Operational Conditions. Robot. Auton. Syst. 2018, 106, 152–164. [Google Scholar] [CrossRef]
  11. Yu, M.; Xue, F.; Ruan, C.; Guo, H. Floor Positioning Method Indoors with Smartphone’s Barometer. Geo-Spat. Inf. Sci. 2019, 22, 138–148. [Google Scholar] [CrossRef]
  12. Hu, G.; Wang, W.; Zhong, Y.; Gao, B.; Gu, C. A New Direct Filtering Approach to INS/GNSS Integration. Aerosp. Sci. Technol. 2018, 77, 755–764. [Google Scholar] [CrossRef]
  13. Xia, X.; Xiong, L.; Lu, Y.; Gao, L.; Yu, Z. Vehicle Sideslip Angle Estimation by Fusing Inertial Measurement Unit and Global Navigation Satellite System with Heading Alignment. Mech. Syst. Signal Process. 2021, 150, 107290. [Google Scholar] [CrossRef]
  14. Chen, C.; Chang, G. Low-Cost GNSS/INS Integration for Enhanced Land Vehicle Performance. Meas. Sci. Technol. 2020, 31, 035009. [Google Scholar] [CrossRef]
  15. Mostafa, M.Z.; Khater, H.A.; Rizk, M.R.; Bahasan, A.M. A Novel GPS/RAVO/MEMS-INS Smartphone-Sensor-Integrated Method to Enhance USV Navigation Systems during GPS Outages. Meas. Sci. Technol. 2019, 30, 095103. [Google Scholar] [CrossRef]
  16. Yoon, J.-H.; Peng, H. A Cost-Effective Sideslip Estimation Method Using Velocity Measurements from Two GPS Receivers. IEEE Trans. Veh. Technol. 2014, 63, 2589–2599. [Google Scholar] [CrossRef]
  17. Bian, H.; Jin, Z.; Tian, W. Study on GPS Attitude Determination System Aided INS Using Adaptive Kalman Filter. Meas. Sci. Technol. 2005, 16, 2072–2079. [Google Scholar] [CrossRef]
  18. Xia, M.; Sun, P.; Guan, L.; Zhang, Z. Research on Algorithm of Airborne Dual-Antenna GNSS/MINS Integrated Navigation System. Sensors 2023, 23, 1691. [Google Scholar] [CrossRef]
  19. Selmanaj, D.; Corno, M.; Panzani, G.; Savaresi, S.M. Vehicle Sideslip Estimation: A Kinematic Based Approach. Control. Eng. Pract. 2017, 67, 1–12. [Google Scholar] [CrossRef]
  20. Yoon, J.-H.; Peng, H. Robust Vehicle Sideslip Angle Estimation through a Disturbance Rejection Filter That Integrates a Magnetometer with GPS. IEEE Trans. Intell. Transport. Syst. 2014, 15, 191–204. [Google Scholar] [CrossRef]
  21. Laftchiev, E.I.; Lagoa, C.M.; Brennan, S.N. Vehicle Localization Using In-Vehicle Pitch Data and Dynamical Models. IEEE Trans. Intell. Transport. Syst. 2015, 16, 206–220. [Google Scholar] [CrossRef]
  22. Zhang, C.; Ran, L.; Song, L. Fast alignment of SINS for marching vehicles based on multi-vectors of velocity aided by GPS and odometer. Sensors 2018, 18, 137. [Google Scholar] [CrossRef]
  23. Dong, P.; Cheng, J.; Liu, L.; Sun, X.; Fan, S. A Heading Angle Estimation Approach for MEMS-INS/GNSS Integration Based on ZHVC and SAUKF. IEEE Access 2019, 7, 154084–154095. [Google Scholar] [CrossRef]
  24. Zhang, Z.; Zhao, J.; Huang, C.; Li, L. Precise and Robust Sideslip Angle Estimation Based on INS/GNSS Integration Using Invariant Extended Kalman Filter. Proc. Inst. Mech. Eng. Part D J. Automob. Eng. 2023, 237, 1805–1818. [Google Scholar] [CrossRef]
  25. Chen, Q.; Zhang, Q.; Niu, X. Estimate the Pitch and Heading Mounting Angles of the IMU for Land Vehicular GNSS/INS Integrated System. IEEE Trans. Intell. Transport. Syst. 2021, 22, 6503–6515. [Google Scholar] [CrossRef]
  26. Shen, N.; Chen, L.; Chen, R. Multi-Route Fusion Method of GNSS and Accelerometer for Structural Health Monitoring. J. Ind. Inf. Integr. 2023, 32, 100442. [Google Scholar] [CrossRef]
  27. Kaygısız, B.H.; Şen, B. In-Motion Alignment of a Low-Cost GPS/INS under Large Heading Error. J. Navig. 2015, 68, 355–366. [Google Scholar] [CrossRef]
  28. Wu, Y.; Wu, M.; Hu, X.; Hu, D. Self-Calibration for Land Navigation Using Inertial Sensors and Odometer: Observability Analy-sis. In AIAA Guidance, Navigation, and Control Conference; American Institute of Aeronautics and Astronautics: Chicago, IL, USA, 2009. [Google Scholar]
  29. Fischler, M.A.; Bolles, R.C. Random Sample Consensus: A Paradigm for Model Fitting with Applications to Image Analysis and Automated Cartography. Commun. ACM 1981, 24, 381–395. [Google Scholar] [CrossRef]
  30. Niu, X.; Zhang, Q.; Gong, L.; Liu, C.; Zhang, H.; Shi, C.; Wang, J.; Coleman, M. Development and Evaluation of GNSS/INS Data Processing Software for Position and Orientation Systems. Surv. Rev. 2015, 47, 87–98. [Google Scholar] [CrossRef]
  31. Chang, X.-W.; Yang, X.; Zhou, T. MLAMBDA: A Modified LAMBDA Method for Integer Least-Squares Estimation. J. Geod. 2005, 79, 552–565. [Google Scholar] [CrossRef]
  32. Zhang, C.; Guo, C.; Zhang, D. Data Fusion Based on Adaptive Interacting Multiple Model for GPS/INS Integrated Navigation System. Appl. Sci. 2018, 8, 1682. [Google Scholar] [CrossRef]
  33. Cui, B.; Chen, X.; Tang, X.; Huang, H.; Liu, X. Robust Cubature Kalman Filter for GNSS/INS with Missing Observations and Colored Measurement Noise. ISA Trans. 2018, 72, 138–146. [Google Scholar] [CrossRef] [PubMed]
  34. Boguspayev, N.; Akhmedov, D.; Raskaliyev, A.; Kim, A.; Sukhenko, A. A Comprehensive Review of GNSS/INS Integration Techniques for Land and Air Vehicle Applications. Appl. Sci. 2023, 13, 4819. [Google Scholar] [CrossRef]
  35. Yin, Z.; Yang, J.; Ma, Y.; Wang, S.; Chai, D.; Cui, H. A Robust Adaptive Extended Kalman Filter Based on an Improved Measurement Noise Covariance Matrix for the Monitoring and Isolation of Abnormal Disturbances in GNSS/INS Vehicle Navigation. Remote Sens. 2023, 15, 4125. [Google Scholar] [CrossRef]
Figure 1. The architecture of the dual-antenna GNSS/INS/Barometer integrated navigation system. G represents values measured by GNSS. δ represents the error value.
Figure 1. The architecture of the dual-antenna GNSS/INS/Barometer integrated navigation system. G represents values measured by GNSS. δ represents the error value.
Sensors 24 01034 g001
Figure 2. Diagram of the coordinate systems.
Figure 2. Diagram of the coordinate systems.
Sensors 24 01034 g002
Figure 3. The experiment vehicle.
Figure 3. The experiment vehicle.
Sensors 24 01034 g003
Figure 4. Acquisition of experimental data in the open and occluded environment: (a) Experiment with real-time scenario in the playground; (b) Test vehicle through the building tunnel; (c) Test vehicle trajectory in the open environment; (d) Test vehicle trajectory in the occluded environment.
Figure 4. Acquisition of experimental data in the open and occluded environment: (a) Experiment with real-time scenario in the playground; (b) Test vehicle through the building tunnel; (c) Test vehicle trajectory in the open environment; (d) Test vehicle trajectory in the occluded environment.
Sensors 24 01034 g004
Figure 5. HDOP during the open and occluded environment experiment: (a) The value of HDOP during the open environment experiment; (b) The value of HDOP during the occluded environment experiment.
Figure 5. HDOP during the open and occluded environment experiment: (a) The value of HDOP during the open environment experiment; (b) The value of HDOP during the occluded environment experiment.
Sensors 24 01034 g005
Figure 6. Acquisition of original IMU data in the open and occluded environments: (a) Original triaxial accelerometer data in the playground; (b) Original triaxial gyroscope data in the playground; (c) Original triaxial accelerometer data in the occluded environment; (d) Original triaxial gyroscope data in the occluded environment.
Figure 6. Acquisition of original IMU data in the open and occluded environments: (a) Original triaxial accelerometer data in the playground; (b) Original triaxial gyroscope data in the playground; (c) Original triaxial accelerometer data in the occluded environment; (d) Original triaxial gyroscope data in the occluded environment.
Sensors 24 01034 g006
Figure 7. The estimation of heading angle during the open and occluded environment experiments: (a) The estimation of heading angle in the open environment; (b) The estimation of heading angle in the occluded environment.
Figure 7. The estimation of heading angle during the open and occluded environment experiments: (a) The estimation of heading angle in the open environment; (b) The estimation of heading angle in the occluded environment.
Sensors 24 01034 g007
Table 1. Characteristics of GNSS, IMU, and barometer module.
Table 1. Characteristics of GNSS, IMU, and barometer module.
ModuleSpecificationsPerformance
GNSSPosition accuracy (RMS *)1.2 m (Plane), 2.5 m (Elevation)
Time accuracy10 ns
Velocity accuracy (RMS)0.02 m/s
Measurement frequency5 Hz
IMUGyroscopeRange±400°/s
Bias stability10°/h
Bias Repeatability10°/h
Measurement frequency100 Hz
AccelerometerRange±5 g
Bias stability0.2 mg
Bias Repeatability0.2 mg
Measurement frequency100 Hz
BarometerHeight accuracy10 cm
Measurement frequency5 Hz
* RMS is Root Mean Square.
Table 2. Heading angle errors during the open and occluded environment experiment.
Table 2. Heading angle errors during the open and occluded environment experiment.
ScenarioMethodMAE (°) 1MAX (°) 2STD (°) 3RMS (°)
the open environmentEKF0.63806.37950.85000.8686
AKF without heading angle0.48572.69240.59560.6174
AKF with heading angle0.44351.14890.32640.5418
the occluded environmentGNSS 42.678916.38103.67313.7129
EKF0.77956.97851.18741.2090
AKF0.50482.90520.50980.6367
1 MAE is Mean Absolute Error. 2 MAX is Maximum. 3 STD is Standard Deviation. 4 GNSS data range from 1 to 82 s.
Disclaimer/Publisher’s Note: The statements, opinions and data contained in all publications are solely those of the individual author(s) and contributor(s) and not of MDPI and/or the editor(s). MDPI and/or the editor(s) disclaim responsibility for any injury to people or property resulting from any ideas, methods, instructions or products referred to in the content.

Share and Cite

MDPI and ACS Style

Jiao, H.; Xu, X.; Chen, S.; Guo, N.; Yu, Z. Improving Vehicle Heading Angle Accuracy Based on Dual-Antenna GNSS/INS/Barometer Integration Using Adaptive Kalman Filter. Sensors 2024, 24, 1034. https://doi.org/10.3390/s24031034

AMA Style

Jiao H, Xu X, Chen S, Guo N, Yu Z. Improving Vehicle Heading Angle Accuracy Based on Dual-Antenna GNSS/INS/Barometer Integration Using Adaptive Kalman Filter. Sensors. 2024; 24(3):1034. https://doi.org/10.3390/s24031034

Chicago/Turabian Style

Jiao, Hongyuan, Xiangbo Xu, Shao Chen, Ningyan Guo, and Zhibin Yu. 2024. "Improving Vehicle Heading Angle Accuracy Based on Dual-Antenna GNSS/INS/Barometer Integration Using Adaptive Kalman Filter" Sensors 24, no. 3: 1034. https://doi.org/10.3390/s24031034

Note that from the first issue of 2016, this journal uses article numbers instead of page numbers. See further details here.

Article Metrics

Back to TopTop