Constraint Wrench Formulation for Closed-Loop Systems Using Two-Level Recursions

Abstract

In order to compute the constraint moments and forces, together referred here as wrenches, in closed-loop mechanical systems, it is necessary to formulate a dynamics problem in a suitable manner so that the wrenches can be computed efficiently. A new constraint wrench formulation for closed-loop systems is presented in this paper using two-level recursions, namely, subsystem level and body level. A subsystem is referred here as the serial- or tree-type branches of a spanning tree obtained by cutting the appropriate joints of the closed loops of the system at hand. For each subsystem, unconstrained Newton–Euler equations of motion are systematically reduced to a minimal set in terms of the Lagrange multipliers representing the constraint wrenches at the cut joints and the driving torques/forces provided by the actuators. The set of unknown Lagrange multipliers and the driving torques/forces associated to all subsystems are solved in a recursive fashion using the concepts of a determinate subsystem. Next, the constraint forces and moments at the uncut joints of each subsystem are calculated recursively from one body to another. Effectiveness of the proposed algorithm is illustrated using a multiloop planar carpet scraping machine and the spatial RSSR (where R and S stand for revolute and spherical, respectively) mechanism.