Voronoi-based trajectory optimization for UGV path planning
principles of robot motion : theory , algorithms , and implementations [ book review ] .