College of Mechanical Engineering and Beijing, Key Laboratory of Measurement and Control of Mechanical and Electrical System, Beijing Information Science and Technology University, Beijing 100192, P.