This paper focuses on the multi-vehicle motion planning (MVMP) problem for cooperative lane changes of connected and automated vehicles (CAVs). The predominant decentralized MVMP methods can hardly explore and utilize the cooperation capability of a multi-vehicle team, thus they usually lead to low-quality solutions. This study proposes a two-stage MVMP framework to find high-quality online solutions. Concretely, at Stage 1, the CAV platoon transfers from its original formation to a sufficiently sparse formation; at Stage 2, all the CAVs simultaneously change lanes with collision avoidance implicitly ensured. The CAVs only involve longitudinal rather than lateral motions at Stage 1, thus the collision-avoidance constraints can be easily handled. Since Stage 2 begins with a sparse formation, the implicitly ensured collision avoidance can be completely omitted then. Through this, our method avoids directly handling the challenging collision avoidance conditions in the original scheme, thereby being able to compute fast. As the vehicles run cooperatively and simultaneously at either stage, the obtained solutions are near-optimal. The completeness, effectiveness, and quality of the proposed two-stage MVMP method are validated through theoretical analysis and comparative simulations.
This study presents a direct trajectory optimization framework for a vertical takeoff and vertical landing (VTVL) reusable rocket with a two-stage structure for a launch mission to simultaneously deliver a payload to the desired orbit and recover the rocket. A two-phase trajectory optimization problem of VTVL reusable rockets is established, with the main features of the flight process. The finite-element collocation approach with Radau collocation is utilized to transcribe the established problem into a nonlinear programming (NLP) problem solved by Interior Point OPTimizer (IPOPT). Novel internal–external-growth initialization strategies are designed to enhance the convergence of solving the NLP problem. The proposed direct trajectory optimization framework is applied to two representative scenarios of VTVL reusable rockets: return to a launch site and return to a drone ship. Simulation results illustrate that the proposed trajectory optimization framework has the adaptability to deal effectively with the complex missions of VTVL reusable rockets.