RSS 2018 paper accepted