Trajectory Planning and Control of Multiple Quadcopters for Mars Exploration

The trajectory optimization of multiple quadcopters for Mars exploration has been a challenging task due to a difficult nonconvex space formed by multiple quadcopters in the flight, the complex dynamics model, and complicated obstacle environments. We propose a distributed optimization algorithm (DiPenOpt) using direct collocation methods to solve the optimization in the nonconvex space. The DiPenOpt algorithm contains a penalty function method to transfer the nonconvex space into a convex one and an iterative optimization strategy employing initial value selection methods to enhance the algorithm’s convergence rate. We design a position-tracking controller to ensure that the quadcopters can effectively follow trajectories generated by the DiPenOpt, regardless of initial position deviations and uncertainties. We compare the results of the DiPenOpt with other algorithms and find that DiPenOpt has a faster solution speed and shows superior robustness for trajectory optimization of multiple quadcopters in large and complex environments. The simulation results show that the position-tracking controller can ensure error convergence and stabilize the flight path when the quadcopter has an initial error.