Control of 6 DOF arm of the Humanoid Robot by Linear Visual Servoing

摘要

This paper proposes a position and posture control method of the 6 DOF arm of the Humanoid Robot by Linear Visual Servoing. It is based on the linear approximation of the forward kinematics which has a similar kinematic structure as a human being. Forward kinematics is the transformation from joint space to binocular visual space. Pseudo inverse matrix of the 3 linear approximation matrices of the 3 points makes it possible to realize position and posture control of 6 DOF arm by Linear Visual Servoing. It is very robust to calibration error of camera angles, because it uses neither camera angles nor joint angles to calculate feedback command. Furthermore, the amount of calculation is very small compared to the conventional visual servoing schemes. Although the conventional 6 DOF arm control methods based on pseudo inverse matrix need non-linear complex calculation using joint angle, the proposed method does not need it. Simulation results are presented to demonstrate the effectiveness of the proposed method.