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