1. The Robotics Institute, Carnegie Mellon University, Pittsburgh, Pennsylvania 15213-3890, USA,
2. Systems Realization Laboratory, G. W. Woodruff School of Mechanical Engineering, Georgia Institute of Technology, Atlanta, Georgia 30332-0405, USA,
3. The Robotics Institute and Electrical and Computer Engineering, Carnegie Mellon University, Pittsburgh, Pennsylvania 15213-3890,