https://roboticsbiz.com/path-planning-algorithms-for-robotic-systems/