Inertial sensor-based humanoid joint state estimation

This work presents methods for the determination of a humanoid robot's joint velocities and accelerations directly from link-mounted Inertial Measurement Units (IMUs) each containing a three-axis gyroscope and a three-axis accelerometer. No information about the global pose of the floating base or its links is required and precise knowledge of the link IMU poses is not necessary due to presented calibration routines. Additionally, a filter is introduced to fuse gyroscope angular velocities with joint position measurements and compensate the computed joint velocities for time-varying gyroscope biases. The resulting joint velocities are subject to less noise and delay than filtered velocities computed from numerical differentiation of joint potentiometer signals, leading to superior performance in joint feedback control as demonstrated in experiments performed on a SARCOS hydraulic humanoid.

[1]  Alfred R. Schuler,et al.  Measuring Rotational Motion with Linear Accelerometers , 1967, IEEE Transactions on Aerospace and Electronic Systems.

[2]  A. King,et al.  Measurement of Angular Acceleration of a Rigid Body Using Linear Accelerometers , 1975 .

[3]  Y. K. Liu Discussion: “Measurement of Angular Acceleration of a Rigid Body Using Linear Accelerometers” (Padgaonkar, A. J., Krieger, K. W., and King, A. I., 1975, ASME J. Appl. Mech., 42, pp. 552–556) , 1976 .

[4]  W. Kabsch A solution for the best rotation to relate two sets of vectors , 1976 .

[5]  G. Legnani,et al.  On the Number and Placement of Accelerometers for Angular Velocity and Acceleration Determination , 2001 .

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

[7]  B. Andrews,et al.  Detecting absolute human knee angle and angular velocity using accelerometers and rate gyroscopes , 2001, Medical and Biological Engineering and Computing.

[8]  Mahmoud El-Gohary,et al.  Joint angle tracking with inertial sensors , 2008, 2008 30th Annual International Conference of the IEEE Engineering in Medicine and Biology Society.

[9]  Peng Cheng,et al.  Joint-Angle Measurement Using Accelerometers and Gyroscopes—A Survey , 2010, IEEE Transactions on Instrumentation and Measurement.

[10]  Pei-Chun Lin,et al.  Design and Implementation of a Nine-Axis Inertial Measurement Unit , 2012, IEEE/ASME Transactions on Mechatronics.

[11]  Jouni Mattila,et al.  MEMS-based state feedback control of multi-body hydraulic manipulator , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[12]  Jouni Mattila,et al.  Geometry-aided angular acceleration sensing of rigid multi-body manipulator using MEMS rate gyros and linear accelerometers , 2013, 2013 IEEE/RSJ International Conference on Intelligent Robots and Systems.

[13]  Jouni Mattila,et al.  Geometry-aided MEMS motion state estimation for multi-body manipulators , 2013, 2013 IEEE/ASME International Conference on Advanced Intelligent Mechatronics.

[14]  Thomas Seel,et al.  IMU-Based Joint Angle Measurement for Gait Analysis , 2014, Sensors.

[15]  Jouni Mattila,et al.  Geometry-aided low-noise angular velocity sensing of rigid-body manipulator using MEMS rate gyros and linear accelerometers , 2014, 2014 IEEE/ASME International Conference on Advanced Intelligent Mechatronics.

[16]  Antonio Bicchi,et al.  Low-cost, fast and accurate reconstruction of robotic and human postures via IMU measurements , 2015, 2015 IEEE International Conference on Robotics and Automation (ICRA).

[17]  X Xinjilefu State Estimation for Humanoid Robots , 2015 .

[18]  Christopher G. Atkeson,et al.  A distributed MEMS gyro network for joint velocity estimation , 2016, 2016 IEEE International Conference on Robotics and Automation (ICRA).