1. School of Computer Science & Technology, Huazhong University of Science & Technology, Wuhan 430074, China; 2. National Numerical Control System Engineering Center, Huazhong University of Science & Technology, Wuhan 430074, China; 3. Robotics Laboratory of the Chinese Academy of Sciences, Shenyang 110016, China