Dynamic motion generation for redundant systems under external 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 problem of predicting the external reaction loads under rigid-body assumption has not been addressed extensively in the literature in terms of optimal motion planning and simulation. In this presentation, we propose a formulation of determining the external reaction loads for redundant systems motion planning. For dynamic equilibrium, the resultant reaction loads that include the effects of inertia, gravity, and general applied loads, are distributed to each contact points. Unknown reactions are determined along with the system configuration at each time step using iterative nonlinear optimization algorithm. The required actuator torques as well as the motion trajectories are obtained while satisfying given constraints. The formulation is applied to several example motions of multi-rigid-body systems such as a simple 3-degree-of-freedom welding manipulator and a highly articulated whole-body human mechanism. The example results are compared with the cases where the reactions are pre-assigned. The proposed formulation demonstrates realistic distribution of external reaction loads and the associated goal-oriented motions that are dynamically consistent.