implemented voronoi update via costmap callback fnc