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