Cooperative object manipulation with contact impact using multiple impedance control

Impedance Control imposes a desired behavior on a single manipulator interacting with its environment. The Multiple Impedance Control (MIC) enforces a designated impedance on both a manipulated object, and all cooperating manipulators. Similar to the standard impedance control, one of the benefits of this algorithm is the ability to perform both free motions and contact tasks without switching control modes. At the same time, the potentially large object inertia and other forces are taken into account. In this paper, the general formulation for the MIC algorithm is developed for distinct cooperating manipulators, and important issues are detailed. Using a benchmark system, the response of the MIC algorithm is compared to that of the Object Impedance Control (OIC). It is shown that in the presence of flexibility, the MIC algorithm results in an improved performance. Next, a system of two cooperating two-link manipulators is simulated, in which a Remote Centre Compliance is attached to the second end-effector. As simulation results show, the response of the MIC algorithm is smooth, even in the presence of an impact due to collision with an obstacle. It is revealed by both error analysis and simulation that under the MIC law, all participating manipulators, and the manipulated object exhibit the same designated impedance behavior. This guarantees good tracking of manipulators and the object based on the chosen impedance laws which describe desired error dynamics, in performing a manipulation task.