Principles of robot motion : theory, algorithms, and implementation - Choset, Howie M (MIT Press, 2005)