1. École de Technologie Supérieure, Montréal, QC H3C 1K3, Canada e-mail:
2. Department of Mechanical Engineering, Carnegie Mellon University, Pittsburgh, PA 15213 e-mail:
3. Robotics Institute, School of Computer Science, Carnegie Mellon University, Pittsburgh, PA 15213 e-mail: