Text this: Principles of robot motion: theory, algorithms, and implementations