1. Department of Mechanics and Maritime Sciences, Chalmers University of Technology, Gothenburg SE-41296, Sweden
2. Robotics Institute, Beihang University, Beijing 100191, China
3. Department of Mechanical Engineering, University of Michigan, Ann Arbor, MI 48109, USA