Vehicle state estimation for INS/GPS aided by sensors fusion and SCKF-based algorithm

Abstract To improve the safety and stability of land vehicles, this paper explores the estimation problem for vehicle states, including lateral velocity and attitude. First, a robust sliding mode observer is introduced to improve the adaptability for uncertain inputs, especially for the varying parameters in the vehicle dynamic model and longitudinal velocity. Furthermore, theoretical studies are performed to enhance the capability of the observer. In order to mitigate errors with the integrated navigation system, sensor drift model is primarily established based on a modified Elman neural network, so as to investigate the coupling between driving motion and errors. In addition, an extended square-root cubature Kalman filter is proposed to combine measurements from different sensors, utilizing a fusion strategy, to deal with severe driving motion and state estimation problems. Finally, simulation and field tests are carried out under a variety of maneuvers and conditions. The approach is compared with existing methods and evaluated experimentally, which indicates its effectiveness in improving the accuracy of vehicle state estimation.

[1]  Zhiyuan Liu,et al.  Design of a Nonlinear Observer for Vehicle Velocity Estimation and Experiments , 2011, IEEE Transactions on Control Systems Technology.

[2]  Jiancheng Fang,et al.  EGP-CDKF for Performance Improvement of the SINS/GNSS Integrated System , 2018, IEEE Transactions on Industrial Electronics.

[3]  Qimin Xu,et al.  A Reliable Fusion Positioning Strategy for Land Vehicles in GPS-Denied Environments Based on Low-Cost Sensors , 2017, IEEE Transactions on Industrial Electronics.

[4]  Jun Liu,et al.  Dual-optimization for a MEMS-INS/GPS system during GPS outages based on the cubature Kalman filter and neural networks , 2019, Mechanical Systems and Signal Processing.

[5]  Dongkui Tan,et al.  Vehicle Sideslip Angle and Road Friction Estimation Using Online Gradient Descent Algorithm , 2018, IEEE Transactions on Vehicular Technology.

[6]  Rajesh Rajamani,et al.  Algorithms for Real-Time Estimation of Individual Wheel Tire-Road Friction Coefficients , 2012 .

[7]  Myoungho Sunwoo,et al.  Interacting Multiple Model Filter-Based Sensor Fusion of GPS With In-Vehicle Sensors for Real-Time Vehicle Positioning , 2012, IEEE Transactions on Intelligent Transportation Systems.

[8]  Jian Wang,et al.  Cooperative Localization of Connected Vehicles: Integrating GNSS With DSRC Using a Robust Cubature Kalman Filter , 2017, IEEE Transactions on Intelligent Transportation Systems.

[9]  Shuo Cheng,et al.  Fusion Algorithm Design Based on Adaptive SCKF and Integral Correction for Side-Slip Angle Observation , 2018, IEEE Transactions on Industrial Electronics.

[10]  A. Khajepour,et al.  Simultaneous Vehicle Real-Time Longitudinal and Lateral Velocity Estimation , 2017, IEEE Transactions on Vehicular Technology.

[11]  Ming Xin,et al.  High-degree cubature Kalman filter , 2013, Autom..

[12]  Rajesh Rajamani,et al.  Tracking of Vehicle Motion on Highways and Urban Roads Using a Nonlinear Observer , 2019, IEEE/ASME Transactions on Mechatronics.

[13]  Ching-Yao Chan,et al.  A Reliable Fusion Methodology for Simultaneous Estimation of Vehicle Sideslip and Yaw Angles , 2016, IEEE Transactions on Vehicular Technology.

[14]  Jianqiang Wang,et al.  Vehicle Trajectory Prediction by Integrating Physics- and Maneuver-Based Approaches Using Interactive Multiple Models , 2018, IEEE Transactions on Industrial Electronics.

[15]  Seibum B. Choi,et al.  Adaptive Scheme for the Real-Time Estimation of Tire-Road Friction Coefficient and Vehicle Velocity , 2017, IEEE/ASME Transactions on Mechatronics.

[16]  James Lam,et al.  A Novel Observer Design for Simultaneous Estimation of Vehicle Steering Angle and Sideslip Angle , 2016, IEEE Transactions on Industrial Electronics.

[17]  Chong Shen,et al.  Application of a genetic algorithm Elman network in temperature drift modeling for a fiber-optic gyroscope. , 2014, Applied optics.

[18]  Giulio Panzani,et al.  Vehicle sideslip estimation: A kinematic based approach , 2017 .

[19]  Xiyuan Chen,et al.  Improved Cubature Kalman Filter for GNSS/INS Based on Transformation of Posterior Sigma-Points Error , 2017, IEEE Transactions on Signal Processing.

[20]  Jian Wang,et al.  High accuracy navigation information estimation for inertial system using the multi-model EKF fusing adams explicit formula applied to underwater gliders. , 2017, ISA transactions.

[21]  Jafar Keighobadi,et al.  Fuzzy-adaptive constrained data fusion algorithm for indirect centralized integrated SINS/GNSS navigation system , 2019, GPS Solutions.

[22]  Dongpu Cao,et al.  A Review of Estimation for Vehicle Tire-Road Interactions Toward Automated Driving , 2019, IEEE Transactions on Systems, Man, and Cybernetics: Systems.

[23]  Seibum B. Choi,et al.  Integrated observer approach using in-vehicle sensors and GPS for vehicle state estimation , 2018 .

[24]  Hamad Ahmed,et al.  Accurate Attitude Estimation of a Moving Land Vehicle Using Low-Cost MEMS IMU Sensors , 2017, IEEE Transactions on Intelligent Transportation Systems.

[25]  Tor Arne Johansen,et al.  On non-linear unknown input observers–applied to lateral vehicle velocity estimation on banked roads , 2007, Int. J. Control.

[26]  María Jesús López Boada,et al.  A robust observer based on H∞ filtering with parameter uncertainties combined with Neural Networks for estimation of vehicle roll angle , 2018 .

[27]  Alexander Katriniok,et al.  Adaptive EKF-Based Vehicle State Estimation With Online Assessment of Local Observability , 2016, IEEE Transactions on Control Systems Technology.

[28]  Jafar Keighobadi,et al.  In-move aligned SINS/GNSS system using recurrent wavelet neural network (RWNN)-based integration scheme , 2018, Mechatronics.

[29]  David M. Bevly,et al.  Integrating INS Sensors With GPS Measurements for Continuous Estimation of Vehicle Sideslip, Roll, and Tire Cornering Stiffness , 2006, IEEE Transactions on Intelligent Transportation Systems.

[30]  Amir Khajepour,et al.  Resilient Corner-Based Vehicle Velocity Estimation , 2018, IEEE Transactions on Control Systems Technology.

[31]  Salah Sukkarieh,et al.  An internal model approach to estimation of systems with arbitrary unknown inputs , 2019, Autom..

[32]  Beatriz L. Boada,et al.  Sensor Fusion Based on a Dual Kalman Filter for Estimation of Road Irregularities and Vehicle Mass Under Static and Dynamic Conditions , 2019, IEEE/ASME Transactions on Mechatronics.