https://markus-x-buchholz.medium.com/social-group-optimization-for-robot-path-planner-in-c-e12e5da37f9e
