IEEE JOURNAL OF ROBOTICS AND AUTOMATION