Artificial potential functions for highway driving with collision avoidance
principles of robot motion : theory , algorithms , and implementations [ book review ] .