, Centre for Robotics, Department of Industrial Engineering, Stellenbosch University, South Africa