Have you tried using AI / ML to solve this problem? I feel like letting it generate optimum load and trajectory would be an interesting challenge.