Multi-robot path planning (CMU 16-811 final project)