Path Planning for Mobile Robot Navigation using Voronoi Diagram and Fast Marching
principles of robot motion : theory , algorithms , and implementations [ book review ] .