Department of Engineering Mathematics, University of Bristol, Bristol, United Kingdom, Bristol Robotics Laboratory (BRL), University of Bristol and University of the West of England, Bristol, United Kingdom.