COM motion estimation of a biped robot based on kinodynamics and torque equilibrium

A novel technique to estimate motion of the center of mass (COM) for a biped robot is proposed. A Kalman filter is synthesized where the time evolution of COM is predicted from the external force and corrected based on kinematic estimation and torque equilibrium. They complementarily work to compensate the initial estimation offset, the error accumulation, and errors in modeled mass properties. It makes use of the authors’ previous method to estimate the translational and rotational motion of the base body from inertial information and joint angle measurements. The information about torque equilibrium helps to reduce an uncertainty of the height of COM and to improve the estimation accuracy of it by utilizing an interference of the horizontal and vertical motion of COM. The parameters are tuned based on error analyses in mass properties and sensor signals. A comparative study showed a better performance of the proposed method than other methods through dynamics simulations.