Probabilistic Contact Estimation and Impact Detection for State Estimation of Quadruped Robots

Reliable state estimation is crucial for stable planning and control of legged locomotion. A fundamental component of a state estimator in legged platforms is Leg Odometry, which only requires information about kinematics and contacts. Many legged robots use dedicated sensors on each foot to detect ground contacts. However, this choice is impractical for many agile legged robots in field operations, as these sensors often degrade and break. Instead, this paper focuses on the development of a robust Leg Odometry module, which does not require contact sensors. The module estimates the probability of reliable contact and detects foot impacts using internal force sensing. This knowledge is then used to improve the kinematics-inertial state estimate of the robot's base. We show how our approach can reach comparable performance to systems with foot sensors. Extensive experimental results lasting over 1 h are presented on our 85 $\text{kg}$ quadrupedal robot HyQ carrying out a variety of gaits.

[1]  Darwin G. Caldwell,et al.  Onboard perception-based trotting and crawling with the Hydraulic Quadruped Robot (HyQ) , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[2]  Seth J. Teller,et al.  Drift-free humanoid state estimation fusing kinematic, inertial and LIDAR sensing , 2014, 2014 IEEE-RAS International Conference on Humanoid Robots.

[3]  Heiko Hirschmüller,et al.  Multisensor data fusion for robust pose estimation of a six-legged walking robot , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

[5]  E. A. Parr 14 – Digital Control Systems , 2003 .

[6]  Roy Featherstone,et al.  Robot Dynamics Algorithms , 1987 .

[7]  D. T. Greenwood,et al.  Advanced Dynamics: Frontmatter , 2003 .

[8]  Guy Bessonnet,et al.  Forces acting on a biped robot. Center of pressure-zero moment point , 2004, IEEE Transactions on Systems, Man, and Cybernetics - Part A: Systems and Humans.

[9]  James Diebel,et al.  Representing Attitude : Euler Angles , Unit Quaternions , and Rotation Vectors , 2006 .

[10]  Roland Siegwart,et al.  State estimation for legged robots on unstable and slippery terrain , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[11]  Roland Siegwart,et al.  Unsupervised identification and prediction of foothold robustness , 2013, 2013 IEEE International Conference on Robotics and Automation.

[12]  Darwin G. Caldwell,et al.  A reactive controller framework for quadrupedal locomotion on challenging terrain , 2013, 2013 IEEE International Conference on Robotics and Automation.

[13]  A. Bowling,et al.  Impact forces and mobility in legged robot locomotion , 2007, 2007 IEEE/ASME international conference on advanced intelligent mechatronics.

[14]  Peter Fankhauser,et al.  Probabilistic foot contact estimation by fusing information from dynamics and differential/forward kinematics , 2016, 2016 IEEE/RSJ International Conference on Intelligent Robots and Systems (IROS).

[15]  Darwin G. Caldwell,et al.  High-slope terrain locomotion for torque-controlled quadruped robots , 2016, Autonomous Robots.

[16]  Ferdinando Cannella,et al.  Design of HyQ – a hydraulically and electrically actuated quadruped robot , 2011 .

[17]  Alessandro De Luca,et al.  Collision Detection and Safe Reaction with the DLR-III Lightweight Manipulator Arm , 2006, 2006 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

[19]  A. Savitzky,et al.  Smoothing and Differentiation of Data by Simplified Least Squares Procedures. , 1964 .

[20]  Daniel E. Koditschek,et al.  Sensor data fusion for body state estimation in a hexapod robot with dynamical gaits , 2006, IEEE Trans. Robotics.

[21]  Darwin G. Caldwell,et al.  Design of the Hydraulically Actuated, Torque-Controlled Quadruped Robot HyQ2Max , 2017, IEEE/ASME Transactions on Mechatronics.

[22]  Nicholas Roy,et al.  State Estimation for Legged Robots: Consistent Fusion of Leg Kinematics and IMU , 2013 .

[23]  Larry H. Matthies,et al.  Real-time pose estimation of a dynamic quadruped in GPS-denied environments for 24-hour operation , 2016, Int. J. Robotics Res..

[24]  Edwin Olson,et al.  A passive solution to the sensor synchronization problem , 2010, 2010 IEEE/RSJ International Conference on Intelligent Robots and Systems.

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

[26]  Darwin G. Caldwell,et al.  RobCoGen: a code generator for efficient kinematics and dynamics of articulated robots, based on Domain Specific Languages , 2016 .

[27]  Alessandro De Luca,et al.  Collision detection and reaction: A contribution to safe physical Human-Robot Interaction , 2008, 2008 IEEE/RSJ International Conference on Intelligent Robots and Systems.