Jackson Shields, University of Sydney, Australian Centre for Field Robotics, Sydney, NSW, Australia, Oscar Pizarro, ACFR, University Of Sydney, Australia and Stefan B Williams, The University of Sydney, Australian Centre for Field Robotics, Sydney, NSW, Australia