ICRA 2014 paper