1. Division of Automatic Control, Department of Electrical Engineering, Linköping University, Linköping, Sweden
2. Australian Centre for Field Robotics, University of Sydney, Sydney, Australia
3. School of Information Technologies, Australian Centre for Field Robotics, University of Sydney, Sydney, Australia