Concurrent motion planning and reaction load distribution for redundant dynamic systems under external holonomic constraints

Dynamics of mechanical systems during motion usually involves reaction forces and moments due to the interaction with external objects or constraints from the environment. The problems of determining the external reaction loads have often been addressed in the literature in terms of forward dynamics solution methods for non-redundant systems. In this article, we propose a numerical formulation of distributing the external reaction loads of redundant systems concurrently with optimal motion planning and simulation. For dynamic equilibrium, the resultant reaction loads that include the effects of inertia, gravity, and general applied loads are distributed to each contact point. Unknown reactions are determined along with the system configuration at each time step using iterative non-linear optimization algorithm. The required actuator torques as well as the motion trajectories are obtained while satisfying the given holonomic constraints. The formulation is applied with two types of discretization methods for the reactions, and several example motions of multi-rigid-body systems, such as a simple 3-degree-of-freedom mechanical manipulator and a highly articulated whole-body human mechanism, are demonstrated. The example results are compared with the cases where the reactions are pre-assigned. The proposed numerical formulation demonstrates the realistic distribution of external reaction loads and the associated goal-oriented motions that are dynamically consistent, and provides alternate schemes for hybrid motion/force control of redundant robots. Copyright © 2011 John Wiley & Sons, Ltd.

[1]  Farhad Aghili,et al.  A unified approach for inverse and direct dynamics of constrained multibody systems based on linear projection operator: applications to control and simulation , 2005, IEEE Transactions on Robotics.

[2]  John M. Hollerbach,et al.  Local versus global torque optimization of redundant manipulators , 1987, Proceedings. 1987 IEEE International Conference on Robotics and Automation.

[3]  David Howard,et al.  Optimization of legged robot locomotion by control of foot-force distribution , 2004 .

[4]  Daniel Dopico,et al.  Two implementations of IRK integrators for real-time multibody dynamics , 2006 .

[5]  Kenneth J. Waldron,et al.  A Solution for the Force Distribution Problem in Redundantly Actuated Closed Kinematic Chains , 1990 .

[6]  Yujiang Xiang,et al.  Optimization‐based dynamic human walking prediction: One step formulation , 2009 .

[7]  Yujiang Xiang,et al.  Dynamic motion planning of overarm throw for a biped human multibody system , 2010 .

[8]  Atsuo Kawamura,et al.  Trajectory generation for redundant manipulators under optimization of consumed electrical energy , 1996, IAS '96. Conference Record of the 1996 IEEE Industry Applications Conference Thirty-First IAS Annual Meeting.

[9]  Martin Buss,et al.  Towards an autonomous, humanoid, and dynamically walking robot: modeling, optimal trajectory planning, hardware architecture, and experiments , 2003 .

[10]  Raymond J. Cipra,et al.  Optimal Contact Force Distribution for Multi-Limbed Robots , 2006 .

[11]  Kazunori Hase,et al.  Development of Three-Diemnsional Whole-Body Musculoskeletal Model for Various Motion Analyses , 1997 .

[12]  Mihai Anitescu,et al.  A constraint‐stabilized time‐stepping approach for rigid multibody dynamics with joints, contact and friction , 2004 .

[13]  Karim Abdel-Malek,et al.  Planning load-effective dynamic motions of highly articulated human model for generic tasks , 2009, Robotica.

[14]  Philip E. Martin,et al.  A Model of Human Muscle Energy Expenditure , 2003, Computer methods in biomechanics and biomedical engineering.

[15]  Peter Betsch,et al.  Rigid body dynamics in terms of quaternions: Hamiltonian formulation and conserving numerical integration , 2009 .

[16]  John Baillieul,et al.  Resolution of Kinematic Redundancy using Optimization Techniques , 1988, 1988 American Control Conference.

[17]  Marco Ceccarelli,et al.  An optimum robot path planning with payload constraints , 2002, Robotica.

[18]  M. Pandy,et al.  Dynamic optimization of human walking. , 2001, Journal of biomechanical engineering.

[19]  F.E. Zajac,et al.  Paraplegic standing controlled by functional neuromuscular stimulation. I. Computer model and control-system design , 1989, IEEE Transactions on Biomedical Engineering.

[20]  Joo Hyun Kim,et al.  Prediction and analysis of human motion dynamics performing various tasks , 2006 .

[21]  Yujiang Xiang,et al.  Generating Effective Whole-Body Motions of a Human-like Mechanism with Efficient ZMP Formulation , 2009, Int. J. Robotics Autom..

[22]  K. W. Lilly,et al.  A constrained motion algorithm for the Shuttle Remote Manipulator System , 1995 .

[23]  A. Nedungadi,et al.  A Local Solution with Global Characteristics for the Joint Torque Optimization of a Redundant Manipulator , 1989 .

[24]  Daniel C. H. Yang,et al.  Feasibility evaluation of dynamically linearized kinematically redundant planar manipulators , 1988, Proceedings. 1988 IEEE International Conference on Robotics and Automation.

[25]  Ronald J. Triolo,et al.  A Computational Technique for Determining the Ground Reaction Forces in Human Bipedal Stance , 2003 .

[26]  Pierre E. Dupont,et al.  Stability of frictional contact in constrained rigid-body dynamics , 1997, IEEE Trans. Robotics Autom..

[27]  Don B. Chaffin,et al.  An ergonomic analysis of the ladder climbing activity , 1990 .

[28]  Karim Abdel-Malek,et al.  Robust control of planar dual-arm cooperative manipulators , 2000 .

[29]  Katsu Yamane,et al.  Dynamics Filter - concept and implementation of online motion Generator for human figures , 2000, IEEE Trans. Robotics Autom..

[30]  O. von Stryk,et al.  Dynamic modeling in the simulation, optimization, and control of bipedal and quadrupedal robots , 2003 .

[31]  M L Audu,et al.  A dynamic optimization technique for predicting muscle forces in the swing phase of gait. , 1987, Journal of biomechanics.

[32]  H. G. Petersen,et al.  Simulating non‐holonomic constraints within the LCP‐based simulation framework , 2006 .

[33]  V. Kumar,et al.  A variational calculus framework for motion planning , 1997, 1997 8th International Conference on Advanced Robotics. Proceedings. ICAR'97.

[34]  Oussama Khatib,et al.  Gauss' principle and the dynamics of redundant and constrained manipulators , 2000, Proceedings 2000 ICRA. Millennium Conference. IEEE International Conference on Robotics and Automation. Symposia Proceedings (Cat. No.00CH37065).

[35]  Karim Abdel-Malek,et al.  Dynamics analysis of linear elastic planar mechanisms , 2007 .

[36]  C. K. Liu,et al.  Learning physics-based motion style with nonlinear inverse optimization , 2005, SIGGRAPH 2005.

[37]  M. Dewar.  Body movements in climbing a ladder. , 1977, Ergonomics.

[38]  Dalong Gao,et al.  Head injury criterion , 2009, IEEE Robotics & Automation Magazine.

[39]  Alexander Rm,et al.  A minimum energy cost hypothesis for human arm trajectories. , 1997 .

[40]  Dimitris N. Metaxas,et al.  Human Motion Planning Based on Recursive Dynamics and Optimal Control Techniques , 2002 .

[41]  Alessandro De Luca,et al.  On the modeling of robots in contact with a dynamic environment , 1991, Fifth International Conference on Advanced Robotics 'Robots in Unstructured Environments.

[42]  Bing-Shiang Yang,et al.  Factors affecting stepladder stability during a lateral weight transfer: a study in healthy young adults. , 2005, Applied ergonomics.

[43]  C. Y. Chung,et al.  Torque Optimizing Control with Singularity-Robustness for Kinematically Redundant Robots , 2000, J. Intell. Robotic Syst..