An approach to simultaneous control of trajectory and interaction forces in dual-arm configurations

An approach to the control of constrained dynamic systems such as multiple arm systems, multifingered grippers, and walking vehicles is described. The basic philosophy is to utilize a minimal set of inputs to control the trajectory and the surplus input to control the constraint or interaction forces and moments in the closed chain. A dynamic control model for the closed chain is derived that is suitable for designing a controller in which the trajectory and the interaction forces and moments are explicitly controlled. Nonlinear feedback techniques derived from differential geometry are then applied to linearize and decouple the nonlinear model. These ideas are illustrated through a planar example in which two arms are used for cooperative manipulation. Results from a simulation are used to illustrate the efficacy of the method