Road Slope Aided Vehicle Position Estimation System Based on Sensor Fusion of GPS and Automotive Onboard Sensors

This paper proposes a road slope aided position estimation algorithm based on the fusion of GPS data with information from automotive onboard sensors. Many previous studies for position estimation did not consider the effect of road slope, although many sloped roads are existing. In order to analyze the influence of road slope on position estimation, theoretical proof and simulation are performed. Based on this analysis, a road slope aided position estimation algorithm is presented, which includes a vehicle motion model that can compensate for the effect of the road slope. This algorithm can estimate the position and road slope simultaneously. Furthermore, by compensating for the error due to the road slope, the algorithm can improve the position estimation accuracy and reliability. The estimation algorithm in this paper is implemented and evaluated using automotive onboard sensors and embedded system; therefore, additional motion sensors and high-performance computational units are not necessary. The experimental results show that the accuracy and reliability of the road slope aided position algorithm provide superior performance compared with a planar vehicle model-based position estimation algorithm in mountainous terrain.

[1]  J. C. Gerdes,et al.  Estimation of vehicle roll and road bank angle , 2004, Proceedings of the 2004 American Control Conference.

[2]  Roland Chapuis,et al.  Accurate Vehicle Positioning on a Numerical Map , 2005 .

[3]  Jihua Huang,et al.  A Low-Order DGPS-Based Vehicle Positioning System Under Urban Environment , 2006, IEEE/ASME Transactions on Mechatronics.

[4]  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.

[5]  Sebastian Thrun,et al.  Junior: The Stanford entry in the Urban Challenge , 2008, J. Field Robotics.

[6]  Rafael Toledo-Moreo,et al.  IMM-Based Lane-Change Prediction in Highways With Low-Cost GPS/INS , 2009, IEEE Transactions on Intelligent Transportation Systems.

[7]  Isaac Skog,et al.  In-Car Positioning and Navigation Technologies—A Survey , 2009, IEEE Transactions on Intelligent Transportation Systems.

[8]  William Whittaker,et al.  Autonomous driving in urban environments: Boss and the Urban Challenge , 2008, J. Field Robotics.

[9]  Myoungho Sunwoo,et al.  Real-Time Road-Slope Estimation Based on Integration of Onboard Sensors With GPS Using an IMMPDA Filter , 2013, IEEE Transactions on Intelligent Transportation Systems.

[10]  Myoungho Sunwoo,et al.  Generation of a Precise Roadway Map for Autonomous Cars , 2014, IEEE Transactions on Intelligent Transportation Systems.

[11]  Michael G. Sideris,et al.  How Accurately Can We Determine Orthometric Height Differences from GPS and Geoid Data , 2003 .

[12]  Ernst D. Dickmanns,et al.  Recursive 3-D Road and Relative Ego-State Recognition , 1992, IEEE Trans. Pattern Anal. Mach. Intell..

[13]  Antonio F. Gómez-Skarmeta,et al.  High-Integrity IMM-EKF-Based Road Vehicle Navigation With Low-Cost GPS/SBAS/INS , 2007, IEEE Transactions on Intelligent Transportation Systems.

[14]  J. Christian Gerdes,et al.  ROAD GRADE AND VEHICLE PARAMETER ESTIMATION FOR LOGITUDINAL CONTROL USING GPS. , 2001 .

[15]  Jerome Douret,et al.  A Reliable and Robust Lane Detection System based on the Parallel Use of Three Algorithms for Driving Safety Assistance , 2006, MVA.

[16]  Hongguang Ma,et al.  Improving Accuracy of the Vehicle Attitude Estimation for Low-Cost INS/GPS Integration Aided by the GPS-Measured Course Angle , 2013, IEEE Transactions on Intelligent Transportation Systems.

[17]  S. Drake.  Converting GPS Coordinates (phil lambdal h) to Navigation Coordination (ENU) , 2002 .

[18]  Rajesh Rajamani,et al.  Real-time identification of road-bank angle using differential GPS , 2004, IEEE Transactions on Control Systems Technology.

[19]  Isaac Skog,et al.  Time Synchronization Errors in Loosely Coupled GPS-Aided Inertial Navigation Systems , 2011, IEEE Transactions on Intelligent Transportation Systems.

[20]  Sen Zhang,et al.  Particle filter based outdoor robot localization using natural features extracted from laser scanners , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

[21]  Giovanni Ulivi,et al.  An outdoor navigation system using GPS and inertial platform , 2001, 2001 IEEE/ASME International Conference on Advanced Intelligent Mechatronics. Proceedings (Cat. No.01TH8556).

[22]  Sebastian Thrun,et al.  Stanley: The robot that won the DARPA Grand Challenge , 2006, J. Field Robotics.

[23]  David M. Bevly,et al.  Global Positioning System (GPS): A Low-Cost Velocity Sensor for Correcting Inertial Sensor Errors on Ground Vehicles , 2004 .

[24]  Ben-Zion Bobrovsky,et al.  A Novel Approach for Modeling Land Vehicle Kinematics to Improve GPS Performance Under Urban Environment Conditions , 2012, IEEE Transactions on Intelligent Transportation Systems.

[25]  William Whittaker,et al.  A robust approach to high‐speed navigation for unrehearsed desert terrain , 2006, J. Field Robotics.

[26]  M. E. Cannon,et al.  GPS/MEMS INS integrated system for navigation in urban areas , 2007 .

[27]  Raja Sengupta,et al.  Kalman Filter-Based Integration of DGPS and Vehicle Sensors for Localization , 2005, IEEE Transactions on Control Systems Technology.

[28]  Sebastien Glaser,et al.  Road bank angle and faults estimation using unknown input proportional-integral observer , 2007, 2007 European Control Conference (ECC).

[29]  Myoungho Sunwoo,et al.  Neural-network multiple models filter (NMM)-based position estimation system for autonomous vehicles , 2013 .

[30]  SkogIsaac,et al.  In-car positioning and navigation technologies , 2009 .

[31]  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.

[32]  Sebastien Glaser,et al.  A model driven 3D lane detection system using stereovision , 2008, 2008 10th International Conference on Control, Automation, Robotics and Vision.

[33]  Hugh F. Durrant-Whyte,et al.  On the role of process models in autonomous land vehicle navigation systems , 2003, IEEE Trans. Robotics Autom..