State estimation for biped robots using multibody dynamics

This paper introduces a new state estimator for biped robots fusing encoder, inertial and force torque measurements. The estimator is implemented as a Kalman filter that uses the dynamical model of the linear inverted pendulum with the center of mass (CoM) state as output. In order to compensate for disturbances and model errors we extend the model by a state for the external force and an additional input which is calculated from the dynamics error in pattern generation. Several simulation results underline the effectiveness of the proposed filter and show its robustness against disturbances. Experimental results and an application example validate the method under real world conditions.

[1]  Takashi Matsumoto,et al.  Real time motion generation and control for biped robot -3rd report: Dynamics error compensation- , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[2]  H. Ulbrich,et al.  System Design and Control of Anthropomorphic Walking Robot LOLA , 2009, IEEE/ASME Transactions on Mechatronics.

[3]  Takashi Matsumoto,et al.  Real time motion generation and control for biped robot -2nd report: Running gait pattern generation- , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[4]  Satoshi Kagami,et al.  Autonomous navigation of a humanoid robot over unknown rough terrain using a laser range sensor , 2012, Int. J. Robotics Res..

[5]  Christopher G. Atkeson,et al.  State estimation of a walking humanoid robot , 2012, 2012 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[6]  Takashi Matsumoto,et al.  Real time motion generation and control for biped robot -1st report: Walking gait pattern generation- , 2009, 2009 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[7]  M. Prokin.  Double buffered wide-range frequency measurement method for digital tachometers , 1991 .

[8]  Twan Koolen,et al.  Capturability-based analysis and control of legged locomotion, Part 2: Application to M2V2, a lower-body humanoid , 2012, Int. J. Robotics Res..

[9]  Yoshihiko Nakamura,et al.  Optimal Filtering for Humanoid Robot State Estimators , 2002 .

[10]  Heinz Ulbrich,et al.  Experiments in fast biped walking , 2011, 2011 IEEE International Conference on Mechatronics.

[11]  Yonghwan Oh,et al.  Estimation of the center of mass of humanoid robot , 2007, 2007 International Conference on Control, Automation and Systems.

[12]  Kazuhito Yokoi,et al.  Biped walking pattern generation by using preview control of zero-moment point , 2003, 2003 IEEE International Conference on Robotics and Automation (Cat. No.03CH37422).

[13]  Satoshi Kagami,et al.  Online Walking Control System for Humanoids with Short Cycle Pattern Generation , 2009, Int. J. Robotics Res..

[14]  Christopher G. Atkeson,et al.  Dynamic state estimation using Quadratic Programming , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[15]  Tomomichi Sugihara,et al.  A dual-stage complementary filter for dead reckoning of a biped robot via estimated contact point , 2013, 2013 13th IEEE-RAS International Conference on Humanoid Robots (Humanoids).

[16]  Benjamin J. Stephens.  State estimation for force-controlled humanoid balance using simple models in the presence of modeling error , 2011, 2011 IEEE International Conference on Robotics and Automation.

[17]  Christopher G. Atkeson,et al.  Push Recovery by stepping for humanoid robots with force controlled joints , 2010, 2010 10th IEEE-RAS International Conference on Humanoid Robots.

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

[19]  Ryosuke Tajima,et al.  Fast running experiments involving a humanoid robot , 2009, 2009 IEEE International Conference on Robotics and Automation.

[20]  Robert Wittmann,et al.  An estimation model for footstep modifications of biped robots , 2014, 2014 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[21]  Alin Albu-Schäffer,et al.  Bipedal walking control based on Capture Point dynamics , 2011, 2011 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[22]  Heinz Ulbrich,et al.  The sensor-controller network of the humanoid robot LOLA , 2012, 2012 12th IEEE-RAS International Conference on Humanoid Robots (Humanoids 2012).

[23]  Masayuki Inaba,et al.  Online decision of foot placement using singular LQ preview regulation , 2011, 2011 11th IEEE-RAS International Conference on Humanoid Robots.

[24]  Friedrich Pfeiffer,et al.  A collocation method for real-time walking pattern generation , 2007, 2007 7th IEEE-RAS International Conference on Humanoid Robots.

[25]  Pierre-Brice Wieber,et al.  Trajectory Free Linear Model Predictive Control for Stable Walking in the Presence of Strong Perturbations , 2006, 2006 6th IEEE-RAS International Conference on Humanoid Robots.

[26]  Satoshi Kagami,et al.  Walking control on uneven terrain with short cycle pattern generation , 2007, 2007 7th IEEE-RAS International Conference on Humanoid Robots.