An unified compliant control algorithm to regulate the force by dual arms is proposed, where tow arms are treated as one arm in a kinematic viewpoint. The force error calculated form the information of two force/torque sensors attached to the end of each arm is transferred to minimum actuator coordinates, and then is distributed to total system actuator coordinates. The position adjustment at the total actuator coordinates is computed based on the effective computed based on the effective compliance matrix with respect to total actuator coordinates, which is obtained by coordinate transformation between the task coordinates and the total actuator coordinates. An experiment is carried out for dual arms with asymmetric kinematic structure to control an interaction force between manipulators and the environment. The performances of the proposed control algorithm are experimentally compared to those of dual arms employing master/slave scheme. The proposed compliant control algorithm not only ouperforms other algorithms, but also can be treated as an unified approach n the sense that it can be applied to arbitrary dual arm systems with general kinematic structures.
DOI 인용 스타일