1. Texas Robotics and Automation Center, Metrica, Inc., Houston, Texas 77058, USA
2. The Robotics Institute, Carnegie Mellon University, Pittsburgh, Pennsylvania 15213-3891, USA
3. Artificial Intelligence Laboratory and Controls Laboratory, Department of Electrical Engineering and Computer Science, University of Michigan, Ann Arbor, Michigan 48109-2110, USA