Optimal motion planning with the half-car dynamical model for autonomous high-speed driving
principles of robot motion : theory , algorithms , and implementations [ book review ] .