基于一致性理论和 S-MPC 的四旋翼编队协同避障

Aiming at the problem of quadrotors unmanned aerial vehicle (UAV) formation maintenance and obstacle avoidance, the safety-critical model predictive control (S-MPC) and consistency theory is proposed to design the formation controller to achieve formation maintenance with obstacle avoidance ability. By using the decentralized S-MPC algorithm, each UAV only plans its own motion to track the trajectory specified by the formation control algorithm within the feasible area that meets the collision avoidance conditions. This paper studies how each decoupled UAV solves the optimization problem with coupling constraints in parallel with other UAVs, so as to ensure the consistency of independent decision-making of each UAV. At the same time, the proposed algorithm introduces the control barrier function (CBF) into the constraints of the MPC controller, so as to ensure that the UAV flies in a safe set far away from obstacles, the planned trajectory is smoother, and the system is reduced energy consumption. Finally, the effectiveness of the proposed method is verified by simulation experiments.