Principles of robot motion: Theory algorithms and Inplementation - Choset, Howie; others (Vidhyanagar PHI, 2010)