IROS 2014 submission