Principles of robot motion : theory, algorithms, and implementation - Choset, Howie M.; Choset, Howie (Intelligent robotics and autonomous agents, 2005)