Shenyang Institute of Automation, Chinese Academy of Sciences, Shenyang 110016, China and Institutes for Robotics and Intelligent Manufacturing, Chinese Academy of Sciences, Shenyang 110169, China and School of Mechanical Engineering and Automation, Northeastern University, Shenyang110169, China