1. College of Information Science and Technology, Beijing University of Chemical Technology, Beijing 100029, P. R. China
2. State Key Laboratory of Robotics and System, Harbin Institute of Technology, Harbin 150001, P. R. China
3. Center for Robotics Research, King’s College London, London WC2R 2LS, UK