1. Autonomous Systems Lab Swiss Federal Institute of Technology (ETH) Tannenstr. 3, 8092 Zürich, Switzerland,
2. Department of Mechanical Engineering, Bucknell University, Lewisburg, PA 17837, USA
3. Autonomous Systems Lab Swiss Federal Institute of Technology (ETH) Tannenstr. 3, 8092 Zürich, Switzerland