generalized voronoi control law to 3 dimensions