added icra 2014 paper