A methodology for controlling motion and constraint forces in holonomically constrained systems

摘要

Holonomic constraints are ubiquitous in multibody systems. We present an approach to effectively address the control of holonomically constrained systems using a novel decomposition of task, constraint, and posture space. In addition to providing a natural approach for motion control in the presence of constraints, this scheme also allows for concurrent specification of desired constraint forces, given sufficient actuation. It does this by exposing both motion coordinates and constraint forces within the control formalism, allowing for substantial flexibility in control synthesis. Implementations are presented based on a partitioning of the constraint forces into controlled and uncontrolled subsets, as well as a specification of implicit conditions on the constraint forces. A number of examples demonstrate the practical efficacy of the approach. Finally, a system-level methodology for constraint management during robot interactions with the environment is presented.