1. Robotics and Autonomous Systems Group, Commonwealth Scientific and Industrial Research Organization (CSIRO), Brisbane, Australia.
2. School of Mechanical and Mining, University of Queensland, Brisbane, Australia.
3. School of Electrical Engineering and Robotics, Queensland University of Technology, Brisbane, Australia.
4. Computational Modelling Group, Commonwealth Scientific and Industrial Research Organization (CSIRO), Melbourne, Australia.