1. Robotics Research Center, School of Mechanical, Electronic and Control Engineering, Beijing Jiaotong University , Beijing 100044 , China
2. Robotics Research Center, School of Mechanical, Electronic and Control Engineering ; Key Laboratory of Vehicle Advanced Manufacturing, Measuring and Control Technology, Ministry of Education, , Beijing 100044 , China
3. Beijing Jiaotong University ; Key Laboratory of Vehicle Advanced Manufacturing, Measuring and Control Technology, Ministry of Education, , Beijing 100044 , China