1. Laboratory of Dynamical Systems, Mechanics, and Control, Instituto de Matemáticas y Física Fundamental, Consejo Superior de Investigaciones Cientificas, Madrid 28006, Spain
2. General Robotics, Automation, Sensing and, Perception Laboratory, University of Pennsylvania, Philadelphia, PA 19104-6228, USA