Patching multi-controller to correctly pass trajectories to controllers in SetPath