IEEE Trans. Robotics Autom.