Two papers accepted to IROS. :robot: