1. Australian Centre for Field Robotics (ACFR), The University of Sydney, Sydney, NSW 2006, Australia
2. e:fs Techhub GmbH, 85080 Gaimersheim, Germany
3. Shenzhen Key Laboratory of Control Theory and Intelligent Systems, and the Guangdong Provincial Key Laboratory of Human-Augmentation and Rehabilitation Robotics in Universities, Southern University of Science and Technology, Shenzhen 518055, China