Vehicle model identification by integrated prediction error minimization

We present a highly effective approach for the calibration of vehicle models. The approach combines the output error technique of system identification theory and the convolution integral solutions of linear systems and stochastic calculus. Rather than calibrate the system differential equation directly for unknown parameters, we calibrate its first integral. This integrated prediction error minimization (IPEM) approach is advantageous because it requires only low-frequency observations of state, and produces unbiased parameter estimates that optimize simulation accuracy for the chosen time horizon. We address the calibration of models that describe both systematic and stochastic dynamics, such that uncertainties can be computed for model predictions. We resolve numerous implementation issues in the application of IPEM, such as the efficient linearization of the dynamics integral with respect to parameters, the treatment of uncertainty in initial conditions, and the formulation of stochastic measurements and measurement covariances. While the technique can be used for any dynamical system, we demonstrate its usefulness for the calibration of wheeled vehicle models used in control and estimation. Specifically we calibrate models of odometry, powertrain dynamics, and wheel slip as it affects body frame velocity. Experimental results are provided for a variety of indoor and outdoor platforms.

[1]  Michael Burke,et al.  Path-following control of a velocity constrained tracked vehicle incorporating adaptive slip estimation , 2012, 2012 IEEE International Conference on Robotics and Automation.

[2]  J. Kruschke Bayesian approaches to associative learning: From passive to active learning , 2008, Learning & behavior.

[3]  I. D. Landau,et al.  On test horizon for model validation by output error , 1994, IEEE Trans. Autom. Control..

[4]  Alonzo Kelly,et al.  A Vector Algebra Formulation of Mobile Robot Velocity Kinematics , 2012, FSR.

[5]  Alexander Rudolph,et al.  Quantification and Estimation of Differential Odometry Errors in Mobile Robotics with Redundant Sensor Information , 2003, Int. J. Robotics Res..

[6]  Kazuya Yoshida,et al.  Terramechanics‐based model for steering maneuver of planetary exploration rovers on loose soil , 2007, J. Field Robotics.

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

[8]  Liqiang Feng,et al.  Measurement and correction of systematic odometry errors in mobile robots , 1996, IEEE Trans. Robotics Autom..

[9]  Alonzo James Kelly Fast and easy systematic and stochastic odometry calibration , 2004, 2004 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS) (IEEE Cat. No.04CH37566).

[10]  Kazuya Yoshida,et al.  Terramechanics-based model for steering maneuver of planetary exploration rovers on loose soil: Research Articles , 2007 .

[11]  Alonzo Kelly,et al.  Online calibration of vehicle powertrain and pose estimation parameters using integrated dynamics , 2012, 2012 IEEE International Conference on Robotics and Automation.

[12]  Alex Ellery,et al.  Terrain Response Estimation Using an Instrumented Rocker-Bogie Mobility System , 2013, IEEE Transactions on Robotics.

[13]  John Bagterp Jorgensen,et al.  Continuous-discrete time prediction-error identification relevant for linear model predictive control , 2007, 2007 European Control Conference (ECC).

[14]  Kaspar Althoefer,et al.  Optical flow-based slip and velocity estimation technique for unmanned skid-steered vehicles , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[15]  Danwei Wang,et al.  Integrated Estimation for Wheeled Mobile Robot posture, velocities, and wheel skidding perturbations , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[16]  Philippe Martinet,et al.  Mixed kinematic and dynamic sideslip angle observer for accurate control of fast off-road mobile robots , 2010 .

[17]  Karl Iagnemma,et al.  A Dynamic-Model-Based Wheel Slip Detector for Mobile Robots on Outdoor Terrain , 2008, IEEE Transactions on Robotics.

[18]  P. Bidaud,et al.  Dynamic sliding mode control of a four-wheel skid-steering vehicle in presence of sliding , 2008 .

[19]  Alonzo Kelly,et al.  Aiding off-road inertial navigation with high performance models of wheel slip , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[20]  Tor Arne Johansen,et al.  Nonlinear vehicle side-slip estimation with friction adaptation , 2008, Autom..

[21]  Biao Huang,et al.  System Identification , 2000, Control Theory for Physicists.

[22]  Lennart Ljung,et al.  System Identification: Theory for the User , 1987 .

[23]  Alonzo Kelly,et al.  Linearized Error Propagation in Odometry , 2004, Int. J. Robotics Res..

[24]  Gianluca Antonelli,et al.  A calibration method for odometry of mobile robots based on the least-squares technique: theory and experimental validation , 2005, IEEE Transactions on Robotics.

[25]  Sebastian Thrun,et al.  Online self-calibration for mobile robots , 1999, Proceedings 1999 IEEE International Conference on Robotics and Automation (Cat. No.99CH36288C).

[26]  Roland Siegwart,et al.  Simultaneous localization and odometry self calibration for mobile robot , 2007, Auton. Robots.

[27]  Pietro Perona,et al.  Learning to predict slip for ground robots , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[28]  Sten Bay Jørgensen,et al.  MPC-Relevant Prediction-Error Identification , 2007, 2007 American Control Conference.

[29]  Wolfram Burgard,et al.  Simultaneous Parameter Calibration, Localization, and Mapping , 2012, Adv. Robotics.

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

[31]  G. De Nicolao System Identification : Problems and perspectives , 2003 .

[32]  Hugh F. Durrant-Whyte,et al.  An Autonomous Guided Vehicle for Cargo Handling Applications , 1995, ISER.

[33]  Giuseppe Oriolo,et al.  Simultaneous maximum-likelihood calibration of odometry and sensor parameters , 2008, 2008 IEEE International Conference on Robotics and Automation.

[34]  Dezhen Song,et al.  Kinematic Modeling and Analysis of Skid-Steered Mobile Robots With Applications to Low-Cost Inertial-Measurement-Unit-Based Motion Estimation , 2009, IEEE Transactions on Robotics.

[35]  Kaspar Althoefer,et al.  The modelling and estimation of driving forces for unmanned ground vehicles in outdoor terrain , 2009, Int. J. Model. Identif. Control..

[36]  Michael Bode Learning the Forward Predictive Model for an Off-Road Skid-Steer Vehicle , 2007 .

[37]  John K. Krusch Bayesian approaches to associative learning: From passive to active learning , 2008 .

[38]  Alonzo Kelly,et al.  A Unified Perturbative Dynamics Approach to Online Vehicle Model Identification , 2011, ISRR.

[39]  Sebastian Thrun,et al.  Discriminative Training of Kalman Filters , 2005, Robotics: Science and Systems.

[40]  Marcello Farina,et al.  Some convergence properties of multi-step prediction error identification criteria , 2008, 2008 47th IEEE Conference on Decision and Control.

[41]  Lindsay Kleeman,et al.  Accurate odometry and error modelling for a mobile robot , 1997, Proceedings of International Conference on Robotics and Automation.

[42]  Peter D. Hoff,et al.  A Covariance Regression Model , 2011, 1102.5721.

[43]  Gaurav S. Sukhatme,et al.  A General Framework for Temporal Calibration of Multiple Proprioceptive and Exteroceptive Sensors , 2010, ISER.

[44]  Alonzo Kelly,et al.  On-Line Mobile Robot Model Identification Using Integrated Perturbative Dynamics , 2010, ISER.

[45]  Agostino Martinelli,et al.  The odometry error of a mobile robot with a synchronous drive system , 2002, IEEE Trans. Robotics Autom..

[46]  Zdzislaw Bubnicki,et al.  Modern Control Theory , 2005 .

[47]  Wei Yu,et al.  Analysis and Experimental Verification for Dynamic Modeling of A Skid-Steered Wheeled Vehicle , 2010, IEEE Transactions on Robotics.

[48]  Mark A. Minor,et al.  Traction estimation and control for Mobile Robots using the wheel slip velocity , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[49]  A. Goldberger,et al.  On the Exact Covariance of Products of Random Variables , 1969 .

[50]  Paul Newman,et al.  Automatic Self-calibration of a Full Field-of-View 3D n-Laser Scanner , 2010, ISER.