Real-Time Road-Slope Estimation Based on Integration of Onboard Sensors With GPS Using an IMMPDA Filter

This paper proposes a road-slope estimation algorithm to improve the performance and efficiency of intelligent vehicles. The algorithm integrates three types of road-slope measurements from a GPS receiver, automotive onboard sensors, and a longitudinal vehicle model. The measurement integration is achieved through a probabilistic data association filter (PDAF) that combines multiple measurements into a single measurement update by assigning statistical probability to each measurement and by removing faulty measurement via the false-alarm function of the PDAF. In addition to the PDAF, an interacting multiple-model filter (IMMF) approach is applied to the slope estimation algorithm to allow adaptation to various slope conditions. The model set of the IMMF is composed of a constant-slope road model (CSRM) and a constant-rate slope road model (CRSRM). The CSRM assumes that the slope of the road is always constant, and the CRSRM assumes that the slope of the road changes at a constant rate. The IMMF adapts the road-slope model to the driving conditions. The developed algorithm is verified and evaluated through experimental and case studies using a real-time embedded system. The results show that the performance and efficiency of the road-slope estimation algorithm is accurate and reliable enough for intelligent vehicle applications.

[1]  D. Gruyer,et al.  A Multiple Model Localization System for Outdoor Vehicles , 2007, 2007 IEEE Intelligent Vehicles Symposium.

[2]  Thiagalingam Kirubarajan,et al.  Estimation with Applications to Tracking and Navigation , 2001 .

[3]  K E N J O H A N S S O N.  Road Slope Estimation with Standard Truck Sensors , 2005 .

[4]  Jon Andersson,et al.  Look Ahead Cruise Control: Road Slope Estimation and Control Sensitivity , 2006 .

[5]  Yuichi Motai,et al.  Multiple model framework of adaptive extended kalman filtering for predicting vehicle location , 2006, 2006 IEEE Intelligent Transportation Systems Conference.

[6]  Bengt Schmidtbauer,et al.  Road Slope and Vehicle Mass Estimation Using Kalman Filtering , 2002 .

[7]  Henry Leung,et al.  EM-IMM based land-vehicle navigation with GPS/INS , 2004, Proceedings. The 7th International IEEE Conference on Intelligent Transportation Systems (IEEE Cat. No.04TH8749).

[8]  Myoungho Sunwoo,et al.  Enhanced Road Boundary and Obstacle Detection Using a Downward-Looking LIDAR Sensor , 2012, IEEE Transactions on Vehicular Technology.

[9]  Y. Bar-Shalom.  Tracking and data association , 1988 .

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

[11]  H. Tsunashima,et al.  Vehicle and road state estimation using interacting multiple model approach , 2006 .

[12]  S. Glaser,et al.  Road slope and vehicle dynamics estimation , 2008, 2008 American Control Conference.

[13]  Martin Larsson.  Road Slope Estimation , 2010 .

[14]  Y. Bar-Shalom,et al.  The interacting multiple model algorithm for systems with Markovian switching coefficients , 1988 .

[15]  Karl Henrik Johansson,et al.  Improved road grade estimation using sensor fusion , 2006 .

[16]  Myoungho Sunwoo,et al.  Integration of multiple vehicle models with an IMM filter for vehicle localization , 2010, 2010 IEEE Intelligent Vehicles Symposium.

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

[18]  Anna G. Stefanopoulou,et al.  Recursive least squares with forgetting for online estimation of vehicle mass and road grade: theory and experiments , 2005 .

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

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

[21]  Hiroshi Ohnishi,et al.  A study on road slope estimation for automatic transmission control , 2000 .

[22]  Y. Bar-Shalom,et al.  The probabilistic data association filter , 2009, IEEE Control Systems.

[23]  Anna G. Stefanopoulou,et al.  Experiments for Online Estimation of Heavy Vehicle’s Mass and Time-Varying Road Grade , 2003 .

[24]  Maya Dawood,et al.  Vehicle geo-localization based on IMM-UKF data fusion using a GPS receiver, a video camera and a 3D city model , 2011, 2011 IEEE Intelligent Vehicles Symposium (IV).

[25]  Karl Henrik Johansson,et al.  Road grade estimation for look-ahead vehicle control using multiple measurement runs , 2010 .

[26]  Myoungho Sunwoo,et al.  Distributed vehicle state estimation system using information fusion of GPS and in-vehicle sensors for vehicle localization , 2011, 2011 14th International IEEE Conference on Intelligent Transportation Systems (ITSC).