https://markus-x-buchholz.medium.com/probabilistic-roadmaps-for-robot-path-planning-in-c-66ac8baefa9b