Principles of robot motion: theory, algorithms, and implementation, Howie M. Choset