https://www.robotsforroboticists.com/robot-motion-path-planning-summary/