论文:2022,Vol:40,Issue(5):1012-1020
引用本文:
闫党辉, 章卫国, 陈航. 基于误差模型的多约束鲁棒编队控制器的设计[J]. 西北工业大学学报
YAN Danghui, ZHANG Weiguo, CHEN Hang. Design of multi-constraint robust formation controller based on error model[J]. Journal of Northwestern Polytechnical University

基于误差模型的多约束鲁棒编队控制器的设计
闫党辉, 章卫国, 陈航
西北工业大学 自动化学院, 陕西 西安 710072
摘要:
无人机(unmanned aerial vehicle,UAV)编队是一个复杂的非线性系统,四旋翼无人机虽然具有诸多优点,但是其动力学模型却是非线性、耦合、欠驱动的,并且物理约束、模型的不确定性以及外界干扰等因素会显著降低基于模型控制器的控制性能。因此,针对四旋翼的编队问题,提出了一种基于误差模型的多约束模型预测控制(model predictive control,MPC)策略。利用拉格朗日-欧拉公式建立无人机的三维空间(three-dimensional,3D)模型,并将四旋翼模型分为旋转子系统(rotational subsystem,RS)和平移子系统(translational subsystem,TS),分别针对2个子系统设计对应的多约束模型预测控制器,增广模型中嵌入了积分器,因此能够消除外部干扰引起的跟踪误差。相较于通常情况下的MPC(regular MPC,RMPC),文中所采用的经过修改的MPC(modified MPC,MMPC),通过对成本函数进行合理修改,不仅能够保证控制器在求解过程中子系统的渐近稳定性,也同时保证了闭环系统的稳定性。在此基础上,对以上算法进行了稳定性分析。仿真结果表明,MMPC不仅具有编队良好的路径跟踪能力,还能够保证在多约束和干扰存在的情况下,取得良好的控制性能。
关键词:    多无人机    编队    干扰    多约束    预测控制   
Design of multi-constraint robust formation controller based on error model
YAN Danghui, ZHANG Weiguo, CHEN Hang
School of Automation, Northwestern Polytechnical University, Xi'an 710072, China
Abstract:
UAVs formation is a complex nonlinear system. Although quadrotor has many advantages, its dynamics model is nonlinear, coupled, and under driven. For model-based controller design, physical constraints, model uncertainties and external disturbances significantly deteriorate control performance. Therefore, a multi-constraints MPC strategy based on error model is proposed for the quadrotor formation. Firstly, a 3D model for quadrotor is established by using the Lagrange-Euler formulation, in which the model is divided into RS and TS. The corresponding multi-constraint MPC is designed for the two subsystems respectively. The tracking errors caused by external disturbances can be eliminated because of the integrator embedded in the augmented model. Comparing with RMPC, by making reasonable modifications to the cost function, the asymptotic stability of the open loop and the closed-loop subsystem can be ensured by MMPC. Moreover, the stability analysis of the above-mentioned algorithm is carried out. The simulation results show that the controller of the formation can not only achieve good path tracking, but also robustness to the multiple constraints and disturbances.
Key words:    multi-UAVs    formation    disturbance    multi-constraints    MPC   
收稿日期: 2021-12-08     修回日期:
DOI: 10.1051/jnwpu/20224051012
基金项目: 国家自然科学基金(62073266)与陕西省飞行控制与仿真技术重点实验室资助
通讯作者:     Email:
作者简介: 闫党辉(1987—),西北工业大学博士研究生,主要从事无人机编队控制研究。e-mail:yandh@mail.nwpu.edu.cn
相关功能
PDF(2149KB) Free
打印本文
把本文推荐给朋友
作者相关文章
闫党辉  在本刊中的所有文章
章卫国  在本刊中的所有文章
陈航  在本刊中的所有文章

参考文献:
[1] GUZEY H M, DIERKS T, JAGANNATHAN S, et al. Modified consensus-based output feedback control of quadrotor UAV formations using neural networks[J]. Journal of Intelligent&Robotic Systems, 2019, 94(1):283-300
[2] YAN D, ZHANG W, CHEN H. Research on consensus formation based on double closed-loop sliding mode control[C]//2019 Chinese Control Conference, 2019:5550-5556
[3] 魏扬,徐浩军,薛源.无人机三维编队保持的自适应抗扰控制器设计[J].系统工程与电子技术,2018,40(12):2758-2765 WEI Yang, XU Haojun, XUE Yuan. Adaptive disturbance rejection controller design for UAV 3D formation keeping[J]. Systems Engineering and Electronics, 2018, 40(12):2758-2765(in Chinese)
[4] ZHEN Z, TAO G, XU Y, et al. Multivariable adaptive control based consensus flight control system for UAVs formation[J]. Aerospace Science and Technology, 2019, 93:105336
[5] ILLE M, NAMERIKAWA T. Collision avoidance between multi-UAV-systems considering formation control using MPC[C]//IEEE International Conference on Advanced Intelligent Mechatronics, 2017:651-656
[6] CHEVET T, MANIU C S, VLAD C, et al. Voronoi-based UAVs formation deployment and reconfiguration using MPC techniques[C]//2018 International Conference on Unmanned Aircraft Systems, 2018:9-14
[7] CAI Z, ZHOU H, ZHAO J, et al. Formation control of multiple unmanned aerial vehicles by event-triggered distributed model predictive control[J]. IEEE Access, 2018, 6:55614-55627
[8] HUANG H, ZHOU H, ZHENG M, et al. Cooperative collision avoidance method for multi-UAV based on Kalman filter and model predictive control[C]//2019 IEEE International Conference on Unmanned Systems and Artificial Intelligence, 2019:1-7
[9] WOLFE S, GIVIGI S, RABBATH C A. Distributed multiple model MPC for target tracking UAVs[C]//2020 International Conference on Unmanned Aircraft Systems, 2020:123-130
[10] ROSA V S M, BELO E M. Virtual structure formation flight control based on nonlinear MPC[C]//2021 International Conference on Unmanned Aircraft Systems, 2021:1383-1390
[11] ZHANG J, SUN T, LIU Z. Robust model predictive control for path-following of under actuated surface vessels with roll constraints[J]. Ocean Engineering, 2017, 143:125-132
[12] 闫党辉,章卫国,陈航,等.具有时延和干扰约束的多无人机滑模一致性编队控制研究[J].西北工业大学学报, 2020, 38(2):7 YAN Danghui, ZHANG Weiguou, CHEN Hang, et al. Research on multi-UAVs'sliding mode consensus formation control with delay and disturbance constraints[J]. Journal of Northwestern Polytechnical University, 2020, 38(2):7(in Chinese)
[13] WANG L. Model predictive control system design and implementation using MATLAB[M]. London:Springer Science&Business Media, 2009
相关文献:
1.王小龙, 孙冲, 方群, 李琪, 宋硕.基于干扰观测器的航天器编队抓捕控制方法[J]. 西北工业大学学报, 2021,39(5): 1012-1021
2.闫党辉, 章卫国, 陈航, 史静平.具有时延和干扰约束的多无人机滑模一致性编队控制研究[J]. 西北工业大学学报, 2020,38(2): 420-426
3.李樾, 韩维, 陈清阳, 张勇.基于快速扩展随机树算法的多无人机编队重构方法研究[J]. 西北工业大学学报, 2019,37(3): 601-611
4.邵壮, 祝小平, 周洲, 王彦雄.无人机编队机动飞行时的队形保持反馈控制[J]. 西北工业大学学报, 2015,33(1): 26-32