Inverse kinematics with floating base and constraints for full body humanoid robot control

This paper explores inverse kinematics for full body, floating base, task space control on a real humanoid robot. We discuss how constraints can be used to address the issue of under-actuation due to floating base, and list the sufficient conditions for maintaining task space control of arbitrary robot tasks. We suggest a controller based on a task priority framework and demonstrate the feasibility of the approach on the SARCOS/ATR CBi humanoid robot. We implement examples of position control via constrained floating base inverse kinematics as first approach to full body model-based inverse dynamics control. The examples demonstrate center of gravity position tracking as well as hand figure-8 tracking while simultaneously balancing.

[1]  M. Vukobratovic,et al.  On the stability of anthropomorphic systems , 1972 .

[2]  T. Yoshikawa,et al.  Task-Priority Based Redundancy Control of Robot Manipulators , 1987 .

[3]  Oussama Khatib,et al.  A unified approach for motion and force control of robot manipulators: The operational space formulation , 1987, IEEE J. Robotics Autom..

[4]  Kazuya Yoshida,et al.  Resolved motion rate control of space manipulators with generalized Jacobian matrix , 1989, IEEE Trans. Robotics Autom..

[5]  Steven Dubowsky,et al.  The Kinematics and Dynamics of Space Manipulators: The Virtual Manipulator Approach , 1990, Int. J. Robotics Res..

[6]  Jean-Jacques E. Slotine,et al.  A general framework for managing multiple tasks in highly redundant robotic systems , 1991, Fifth International Conference on Advanced Robotics 'Robots in Unstructured Environments.

[7]  Steven Dubowsky,et al.  The kinematics, dynamics, and control of free-flying and free-floating space robotic systems , 1993, IEEE Trans. Robotics Autom..

[8]  Stefano Chiaverini,et al.  Singularity-robust task-priority redundancy resolution for real-time kinematic control of robot manipulators , 1997, IEEE Trans. Robotics Autom..

[9]  Ronan Boulic,et al.  Task-priority formulations for the kinematic control of highly redundant articulated structures , 1998, Proceedings. 1998 IEEE/RSJ International Conference on Intelligent Robots and Systems. Innovations in Theory, Practice and Applications (Cat. No.98CH36190).

[10]  Bruno Siciliano,et al.  Kinematic control of redundant free-floating robotic systems , 2001, Adv. Robotics.

[11]  Miomir Vukobratovic,et al.  Zero-Moment Point - Thirty Five Years of its Life , 2004, Int. J. Humanoid Robotics.

[12]  杉原 知道,et al.  Mobility enhancement control of humanoid robot based on reaction force manipulation via whole body motion , 2004 .

[13]  M. Mistry,et al.  Arm movement experiments with joint space force fields using an exoskeleton robot , 2005, 9th International Conference on Rehabilitation Robotics, 2005. ICORR 2005..

[14]  Oussama Khatib,et al.  Control of Free-Floating Humanoid Robots Through Task Prioritization , 2005, Proceedings of the 2005 IEEE International Conference on Robotics and Automation.

[15]  Jun Nakanishi,et al.  A Bayesian Approach to Nonlinear Parameter Identification for Rigid Body Dynamics , 2006, Robotics: Science and Systems.

[16]  Oussama Khatib,et al.  Contact consistent control framework for humanoid robots , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[17]  Oussama Khatib,et al.  A whole-body control framework for humanoids operating in human environments , 2006, Proceedings 2006 IEEE International Conference on Robotics and Automation, 2006. ICRA 2006..

[18]  Jun Nakanishi,et al.  Inverse Dynamics Control with Floating Base and Constraints , 2007, Proceedings 2007 IEEE International Conference on Robotics and Automation.

[19]  Jun Morimoto,et al.  CB: A Humanoid Research Platform for Exploring NeuroScience , 2006, 2006 6th IEEE-RAS International Conference on Humanoid Robots.

[20]  Jun Nakanishi,et al.  Task space control with prioritization for balance and locomotion , 2007 .

[21]  Jun Nakanishi,et al.  Operational Space Control: A Theoretical and Empirical Comparison , 2008, Int. J. Robotics Res..

[22]  Oussama Khatib,et al.  A Unified Framework for Whole-Body Humanoid Robot Control with Multiple Constraints and Contacts , 2008, EUROS.