Principles Of Robot Motion door Sebastian Thrun, Howie M. Choset & George A. Kantor