Robot motion planning based on Voronoi