https://www.techcounsellor.com/2017/06/motion-planning-robot-using-voronoi-diagram/