Nonlinear programming for multi-vehicle motion planning with homotopy initialization strategies | IEEE Conference Publication | IEEE Xplore