A dynamic hybrid position/force control method is developed for the coordination of two manipulators of a dual-arm robot to cope with the case of dual-arm tightly cooperate a common rigid object in the presence of environmental constraint. Begin with the definition of a group of generalized motion and force vectors used for task description, and by synthesizing the object dynamics and manipulator dynamics, an object-oriented dynamic equation of the dual-arm rigid coordination system is first derived, where relationships between object motion, internal stress force, and environmental contact force are explicitly presented. Furthermore, this equation and that of single arm dynamics in Cartesian still remain the same form. Based on this definition and description, the dynamic hybrid position/force control scheme for dual-arm symmetric coordination is then designed, and the decomposition and parallel realization of the control algorithm is also discussed. Several experiments have been done on two coordinated PUMA562 robot manipulators, which show that the proposed method works effectively, where the object motion and internal/external force can be simultaneously controlled during cooperation.
Theory of arbitrary rigid object motion autofocus for non-uniform target rotation and translation
