1. Institute of Robotics and Intelligent Systems, ETH Zurich, CH-8092 Zurich, Switzerland, Department of Mechanical Engineering, University of Utah, Salt Lake City, Utah 84112, and Department of Electrical and Computer Engineering, Michigan State University, East Lansing, Michigan 48824