1. ARC Centre of Excellence for Autonomous Systems, Australian Centre for Field Robotics (ACFR), The University of Sydney, Australia,
2. ARC Centre of Excellence for Autonomous Systems, Australian Centre for Field Robotics (ACFR), The University of Sydney, Australia
3. Department of Automation and Systems Technology, Aalto University, Aalto, Finland