State estimation for legged robots on unstable and slippery terrain

This paper presents a state estimation approach for legged robots based on stochastic filtering. The key idea is to extract information from the kinematic constraints given through the intermittent contacts with the ground and to fuse this information with inertial measurements. To this end, we design an unscented Kalman filter based on a consistent formulation of the underlying stochastic model. To increase the robustness of the filter, an outliers rejection methodology is included into the update step. Furthermore, we present the nonlinear observability analysis of the system, where, by considering the special nature of 3D rotations, we obtain a relatively simple form of the corresponding observability matrix. This yields, that, except for the global position and the yaw angle, all states are in general observable. This also holds if only one foot is in contact with the ground. The presented filter is evaluated on a real quadruped robot trotting over an uneven and slippery terrain.

[1]  Franck Plestan,et al.  Estimation of Absolute Orientation for a Bipedal Robot: Experimental Results , 2011, IEEE Transactions on Robotics.

[2]  Eduardo Mario Nebot,et al.  An outlier-robust Kalman filter , 2011, 2011 IEEE International Conference on Robotics and Automation.

[3]  Mike Stilman,et al.  State Estimation for Legged Robots - Consistent Fusion of Leg Kinematics and IMU , 2012, RSS 2012.

[4]  Udo Frese,et al.  Integrating generic sensor fusion algorithms with sound state representations through encapsulation of manifolds , 2011, Inf. Fusion.

[5]  Daniel E. Koditschek,et al.  Sensor data fusion for body state estimation in a hexapod robot with dynamical gaits , 2005, IEEE Transactions on Robotics.

[6]  Rüdiger Dillmann,et al.  Localization of Walking Robots , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[7]  M. West.  Robust Sequential Approximate Bayesian Estimation , 1981 .

[8]  A. Krener,et al.  Nonlinear controllability and observability , 1977 .

[9]  Gerald P. Roston,et al.  Dead Reckoning Navigation For Walking Robots , 1992, Proceedings of the IEEE/RSJ International Conference on Intelligent Robots and Systems.

[10]  Roland Siegwart,et al.  State Estimation for Legged Robots - Consistent Fusion of Leg Kinematics and IMU , 2012, Robotics: Science and Systems.

[11]  Larry H. Matthies,et al.  Robust multi-sensor, day/night 6-DOF pose estimation for a dynamic legged vehicle in GPS-denied environments , 2012, 2012 IEEE International Conference on Robotics and Automation.

[12]  Xiaoji Niu,et al.  Analysis and Modeling of Inertial Sensors Using Allan Variance , 2008, IEEE Transactions on Instrumentation and Measurement.

[13]  Surya P. N. Singh,et al.  Optical Flow Aided Motion Estimation for Legged Locomotion , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[14]  Matej Hoffmann,et al.  Dead Reckoning in a Dynamic Quadruped Robot Based on Multimodal Proprioceptive Sensory Information , 2013, IEEE Transactions on Robotics.

[15]  Shuuji Kajita,et al.  Slip observer for walking on a low friction floor , 2005, 2005 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[16]  Uluc Saranli,et al.  Model-Based Proprioceptive State Estimation for Spring-Mass Running , 2011, Robotics: Science and Systems.

[17]  Annett Stelzer,et al.  A leg proprioception based 6 DOF odometry for statically stable walking robots , 2013, Auton. Robots.

[18]  Stefan Schaal,et al.  A Kalman filter for robust outlier detection , 2007, 2007 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[19]  H. Sorenson,et al.  Recursive bayesian estimation using gaussian sums , 1971 .

[20]  Nori Okita,et al.  A novel foot slip detection algorithm using unscented Kalman Filter innovation , 2012, 2012 American Control Conference (ACC).

[21]  Roland Siegwart,et al.  Starleth: A compliant quadrupedal robot for fast, efficient, and versatile locomotion , 2012 .

[22]  Simon J. Julier,et al.  The scaled unscented transformation , 2002, Proceedings of the 2002 American Control Conference (IEEE Cat. No.CH37301).

[23]  Stergios I. Roumeliotis,et al.  A Kalman Filter-Based Algorithm for IMU-Camera Calibration: Observability Analysis and Performance Evaluation , 2008, IEEE Transactions on Robotics.

[24]  Heiko Hirschmüller,et al.  Stereo-vision-based navigation of a six-legged walking robot in unknown rough terrain , 2012, Int. J. Robotics Res..