Principles of robot motion: theory, algorithms, and implementations - - (Prentice Hall)