SERVO-CONSTRAINTS FOR CONTROL OF FLEXIBLE MULTIBODY SYSTEMS WITH CONTACT

This paper presents inversion based feedforward control design for flexible multibody systems with kinematic loops and end-effector contact. The inverse model provides for a given desired output trajectories, e.g. end-effector point and contact force, the required control inputs for exact output reproduction. A very appealing and efficient model inversion approach for such multibody systems is the use of so-called servo-constraints. These can be seen as an extension of classical mechanical constraints and yield a set of differential-algebraic equations. This allows an efficient numerical solution without burdensome symbolic manipulations. In addition, the use of servo-constraints allows the straight-forward treatment of flexible multibody systems with various topologies. The arising set of differential-algebraic equations describes the inverse model. The inverse model might be purely algebraic or include a dynamical part, which is called internal dynamics in nonlinear control theory. For its numerical solution it is advisable to transform the set of differential-algebraic equations to its underlying set of ordinary differential equations. The solution method for this internal dynamics depends then on its stability. For systems with unstable internal dynamics, as considered in this paper; a solution can be computed from a boundary-value problem. The efficiency of this approach is demonstrated for a flexible multibody system with a kinematic loop and a closed end-effector contact.