National Key Laboratory of Electro-Mech. System and Control, School of Mechatronical Engineering, Beijing Institute of Technology