### A geometric algorithm for the output functional controllability in general manipulation systems and mechanisms

In this paper the control of robotic manipulation is investigated. Manipulation system analysis and control are approached in a general framework. The geometric aspect of manipulation system dynamics is strongly emphasized by using the well developed techniques of geometric multivariable control theory. The focus is on the (functional) control of the crucial outputs in robotic manipulation, namely the reachable internal forces and the rigid-body object motions. A geometric control procedure is outlined...