Force feedback control and collision avoidance of redundant manipulator

A method of compliant and collision avoidance control is presented. The collision avoidance motion is first generated in off-line routine and its data are stored as as a sequence of desired joint angles. Next, virtual impedance model-following control is employed as force feedback control. Redundancy is used for minimization of the variance from the desired joint angle during compliant motion. In particular, the computation time for the inverse kinematics at each sampling time was reduced by using approximate values of Jacobian matrix. The stability of the control system is analyzed and the effectiveness of the proposed method is discussed