https://markus-x-buchholz.medium.com/jaya-optimization-algorithm-for-robot-2d-3d-path-planner-in-c-170ffb945b26