Algorithmic Foundations of Robotics VI