Planning of multiple robot trajectories in distinctive topologies
Efficient trajectory optimization using a sparse model