Model‐based Prediction of Skid‐steer Robot Kinematics Using Online Estimation of Track Instantaneous Centers of Rotation

This paper presents a kinematic extended Kalman filter EKF designed to estimate the location of track instantaneous centers of rotation ICRs and aid in model-based motion prediction of skid-steer robots. Utilizing an ICR-based kinematic model has resulted in impressive odometry estimates for skid-steer movement in previous works, but estimation of ICR locations was performed offline on recorded data. The EKF presented here utilizes a kinematic model of skid-steer motion based on ICR locations. The ICR locations are learned by the filter through the inclusion of position and heading measurements. A background on ICR kinematics is presented, followed by the development of the ICR EKF. Simulation results are presented to aid in the analysis of noise and bias susceptibility. The experimental platforms and sensors are described, followed by the results of filter implementation. Extensive field testing was conducted on two skid-steer robots, one with tracks and another with wheels. ICR odometry using learned ICR locations predicts robot position with a mean error of -0.42i¾?m over 40.5i¾?m of travel during one tracked vehicle test. A test consisting of driving both vehicles approximately 1,000i¾?m shows clustering of ICR estimates for the duration of the run, suggesting that ICR locations do not vary significantly when a vehicle is operated with low dynamics.

[1]  Morgan Quigley,et al.  ROS: an open-source Robot Operating System , 2009, ICRA 2009.

[2]  Roland Siegwart,et al.  Computer Vision Methods for Improved Mobile Robot State Estimation in Challenging Terrains , 2006, J. Multim..

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

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

[5]  Garrison W. Cottrell,et al.  Gamma‐SLAM: Visual SLAM in unstructured environments using variance grid maps , 2009, J. Field Robotics.

[6]  Jewon Lee,et al.  Fuzzy Vector Field Orientation Feedback Control-Based Slip Compensation for Trajectory Tracking Control of a Four Track Wheel Skid-steered Mobile Robot , 2013 .

[7]  James R. Bergen,et al.  Visual odometry , 2004, Proceedings of the 2004 IEEE Computer Society Conference on Computer Vision and Pattern Recognition, 2004. CVPR 2004..

[8]  Xiaojing Song,et al.  A Kalman Filter-Integrated Optical Flow Method for Velocity Sensing of Mobile Robots , 2011, IEEE/ASME Transactions on Mechatronics.

[9]  Jo Yung Wong,et al.  Theory of ground vehicles , 1978 .

[10]  J. Almeida,et al.  Real time egomotion of a nonholonomic vehicle using LIDAR measurements , 2013, J. Field Robotics.

[11]  Kaspar Althoefer,et al.  Slip parameter estimation for tele-operated ground vehicles in slippery terrain , 2011 .

[12]  Pietro Perona,et al.  Slip Prediction Using Visual Information , 2006, Robotics: Science and Systems.

[13]  Steven Mills,et al.  Bag‐of‐words‐driven, single‐camera simultaneous localization and mapping , 2011, J. Field Robotics.

[14]  Hugh F. Durrant-Whyte,et al.  Estimation of track-soil interactions for autonomous tracked vehicles , 1997, Proceedings of International Conference on Robotics and Automation.

[15]  Kaspar Althoefer,et al.  Modelling and control of an unmanned excavator vehicle , 2003 .

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

[17]  J Y Wong,et al.  A general theory for skid steering of tracked vehicles on firm ground , 2001 .

[18]  S. Ali A. Moosavian,et al.  Experimental slip estimation for exact kinematics modeling and control of a Tracked Mobile Robot , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[19]  Lina,et al.  Fuzzy-Appearance Manifold and Fuzzy-Nearest Distance Calculation for Model-Less 3D Pose Estimation of Degraded Face Images , 2013 .

[20]  Dezhen Song,et al.  IMU-based localization and slip estimation for skid-steered mobile robots , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[21]  Danwei Wang,et al.  Modeling and Analysis of Skidding and Slipping in Wheeled Mobile Robots: Control Design Perspective , 2008, IEEE Transactions on Robotics.

[22]  Gianni Ferretti,et al.  Modelling and simulation of an agricultural tracked vehicle , 1997 .

[23]  Dezhen Song,et al.  Adaptive Trajectory Tracking Control of Skid-Steered Mobile Robots , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[24]  Salvador Pedraza,et al.  Approximating Kinematics for Tracked Mobile Robots , 2005, Int. J. Robotics Res..

[25]  Dariusz Pazderski,et al.  Modeling and control of a 4-wheel skid-steering mobile robot , 2004 .

[26]  Wei Yu,et al.  Power modeling of a skid steered wheeled robotic ground vehicle , 2009, 2009 IEEE International Conference on Robotics and Automation.

[27]  John Enright,et al.  Visual odometry aided by a sun sensor and inclinometer , 2011 .

[28]  Garrison W. Cottrell,et al.  Gamma-SLAM: Visual SLAM in unstructured environments using variance grid maps , 2009 .

[29]  Kostas J. Kyriakopoulos,et al.  A dead-reckoning scheme for skid-steered vehicles in outdoor environments , 2004, IEEE International Conference on Robotics and Automation, 2004. Proceedings. ICRA '04. 2004.

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

[31]  Salvador Pedraza,et al.  Power Consumption Modeling of Skid-Steer Tracked Mobile Robots on Rigid Terrain , 2009, IEEE Transactions on Robotics.

[32]  R G Longoria,et al.  Slip estimation for small-scale robotic tracked vehicles , 2010, Proceedings of the 2010 American Control Conference.

[33]  Benjamin C. Kuo,et al.  AUTOMATIC CONTROL SYSTEMS , 1962, Universum:Technical sciences.