基于高阶控制障碍函数的多固定翼无人机鲁棒避障安全编队跟踪控制

Robust Obstacle Avoidance and Safe Formation Tracking Control for Multiple Fixed-wing UAVs Based on High-order Control Barrier Functions

  • 摘要: 在多固定翼无人机编队跟踪控制问题中,系统地处理输入饱和约束、外界输入扰动以及无人机间避碰安全约束存在着挑战。针对这些挑战,本文提出了一种基于高阶控制障碍函数方法的分布式鲁棒避障协同编队控制律。首先,在不考虑避障约束的情况下,设计了一种满足输入和速度约束的多固定翼无人机标称鲁棒编队跟踪控制律。该标称控制律基于滑模控制方法,能够在有界输入扰动影响下实现精准的编队跟踪控制。然后,针对无人机之间的避障要求以及无人机与障碍物之间的避障要求,分别设计了考虑输入约束的改进高阶控制障碍函数,并基于不变集理论,推导了存在外界输入扰动情况下的线性控制输入避障约束条件。最后,基于标称编队跟踪控制律和鲁棒控制输入避障约束条件,为各固定翼无人机构造了一个局部二次规划问题,并通过求解该问题得到最终的鲁棒避障安全编队跟踪控制律。仿真实例表明,本文设计的控制律相较于不考虑外界输入扰动的控制律而言可以有效地处理扰动,相较于基于势函数方法的控制律而言减轻了系统产生的震颤并且更好地处理了无人机的速度约束,相较于基于分布式MPC(模型预测控制)方法的控制律而言在计算时间方面有了显著提升。上述结果验证了所设计控制律的创新性和有效性。

     

    Abstract: For formation tracking control of multiple fixed-wing UAVs (unmanned aerial vehicles), there are significant challenges in systematically tackling input saturation constraints, external input disturbances, and safety constraints of collision avoidance among UAVs. To solve this problem, a distributed and robust control law for obstacle avoidance and cooperative formation is proposed based on higher-order control barrier functions. Firstly, a nominal robust formation tracking control law for multiple fixed-wing UAVs is designed without initially considering obstacle avoidance constraints, which satisfies input and velocity constraints. The proposed nominal control law is based on sliding mode control methods, and can implement precise formation tracking control in the presence of bounded input disturbances. Secondly, some improved high-order control barrier functions are designed with the input constraints taken into consideration, for the obstacle avoidance among the UAVs, and between the UAV and the obstacle, respectively. The obstacle avoidance constraints for linear control inputs are derived in the presence of external input disturbances, based on the invariant set theory. Finally, a local quadratic programming problem is formulated for each fixed-wing UAV, based on the nominal formation tracking control law and the robust control input constraints for obstacle avoidance, and the final robust tracking control law for obstacle avoidance and safe formation can be obtained by solving this problem. Simulation examples demonstrate that the proposed control law can effectively handle the disturbances compared to the control laws without considering external input disturbances, and can reduce system oscillations and better handle UAV speed constraints compared to the control laws based on potential function methods. Additionally, it achieves significant improvements in computation time compared to the control laws based on distributed MPC (model predictive control) methods. The above results validate the innovation and effectiveness of the designed control law.

     

/

返回文章
返回