published in IEEE transactions on automation science and engineering : a publication of the IEEE Robotics and Automation Society Journal