https://123dok.org/document/y6eom377-trajectory-planning-energy-efficiency-industrial-robotic-systems.html