Best Paper Award Finalist at Robotics: Science and Systems (RSS)