1. Beijing Advanced Innovation Center for Intelligent Robotics and Systems, Beijing Institute of Technology, Beijing 100081, P. R. China
2. School of Mechantronical Engineering, Beijing Institute of Technology, Beijing 100081, P. R. China
3. Department of Industrial Engineering, University of Rome Tor Vergata, Via del Politecnico 1, 00133 Roma, Italy