1. Department of Mechanical and Aerospace Engineering, Rutgers University, Piscataway, NJ 08854 e-mail:
2. Research Center of Intelligent Robotics, School of Astronautics, Northwestern Polytechnical University, Xi'an, Shaanxi 710072, China e-mail:
3. Professor Department of Mechanical and Aerospace Engineering, Rutgers University, Piscataway, NJ 08854 e-mail:
4. Institute of Robotics and Automatic Information System, Nankai University, Tianjin 300071, China e-mail:
5. School of Mechatronic Engineering and Automation, Shanghai University, Shanghai 200072, China e-mail: