added IROS14 paper