1. School of Automation Science and Electrical Engineering, Beihang University, Beijing, P.R. China
2. LARM: Laboratory of Robotics and Mechatronics, University of Cassino, Cassino (Fr), Italy
3. Robotics Institute, Beihang University, Beijing, P. R. China