1. Design, Automation, Robotics, and Control (DARC) Lab, Department of Mechanical Engineering, Robotics Center, University of Utah, Salt Lake City, UT 84112 e-mail:
2. Key Laboratory of System Control and Information Processing, Department of Automation, Shanghai Jiao Tong University, Shanghai 200240, China e-mail: