IEEE TRANSACTIONS ON ROBOTICS AND AUTOMATION