Algorithmic Foundations Of Robotics by J.D. Boissonnat & J. Burdick