A conference paper is accepted to ICRA! :sparkles: :smile: