Robotic Path Optimization