, General Robotics, Automation, Sensing & Perception (GRASP) Laboratory, University of Pennsylvania, Philadelphia, USA