Algorithmic Foundations of Robotics V