Rao-Blackwellised particle filtering for low-cost encoder/INS/GNSS integrated vehicle navigation with wheel slipping

This study presents a Rao-Blackwellised particle filter (RBPF)-based encoder/inertial navigation system (INS)/global navigation satellite system (GNSS) integration method for improving the navigation performance of an autonomous land vehicle (ALV) with wheel slipping. In contrast to traditional integration methods, the proposed integration method introduces an overall wheel slip consideration for the ALV, which greatly improves the accuracy of the velocity estimation, especially when the inertial sensor is low cost. Additionally, the proposed integrated system uses double-difference pseudorange measurements instead of single point positioning results provided by low-cost GNSS receivers, which greatly improves the accuracy of the position estimation. To verify the navigation performance of the proposed integrated system, comparisons between the states estimated by the proposed system, the EKF-based integrated system and the joint wheel-slip and motion-estimation system are provided. The results of the experiment show that the proposed integrated system has the highest accuracy in both the position estimation and the velocity estimation among the three compared systems, and can improve the navigation performance during GNSS signals outages.

[1]  Karl Berntorp,et al.  Joint Wheel-Slip and Vehicle-Motion Estimation Based on Inertial, GPS, and Wheel-Speed Sensors , 2016, IEEE Transactions on Control Systems Technology.

[2]  Aboelmagd Noureldin,et al.  Vehicle navigator using a mixture particle filter for inertial sensors/odometer/map data/GPS integration , 2012, IEEE Transactions on Consumer Electronics.

[3]  Sungshin Kim,et al.  Inertial navigation system for an automatic guided vehicle with Mecanum wheels , 2012 .

[4]  Kai Hwang,et al.  Intelligent Carpool Routing for Urban Ridesharing by Mining GPS Trajectories , 2014, IEEE Transactions on Intelligent Transportation Systems.

[5]  W. Tian,et al.  Particle filter for sensor fusion in a land vehicle navigation system , 2005 .

[6]  Fredrik Gustafsson,et al.  Particle filters for positioning, navigation, and tracking , 2002, IEEE Trans. Signal Process..

[7]  Naser El-Sheimy,et al.  Two-Filter Smoothing for Accurate INS/GPS Land-Vehicle Navigation in Urban Centers , 2010, IEEE Transactions on Vehicular Technology.

[8]  Seung-Woo Seo,et al.  Generation of a Precise and Efficient Lane-Level Road Map for Intelligent Vehicle Systems , 2017, IEEE Transactions on Vehicular Technology.

[9]  Baiqing Hu,et al.  Huber’s M-Estimation-Based Process Uncertainty Robust Filter for Integrated INS/GPS , 2015, IEEE Sensors Journal.

[10]  Hugh F. Durrant-Whyte,et al.  The aiding of a low-cost strapdown inertial measurement unit using vehicle model constraints for land vehicle applications , 2001, IEEE Trans. Robotics Autom..