1. Department of Mechanical and Automation Engineering, The Chinese University of Hong Kong, The Robotics Institute, Carnegie Mellon University, Pittsburgh, Pennsylvania, 15213 USA
2. The Robotics Institute, Carnegie Mellon University, Pittsburgh, Pennsylvania, 15213 USA
3. Department of Mechanical and Automation Engineering, The Chinese University of Hong Kong