This is a pre-copyedited, author-produced version of an article accepted for publication in Conference Towards Autonomous Robotic Systems following peer review. The version of record is available https://link.springer.com/chapter/10.1007/978-3-319-64107-2_35