基于扰动观测器的飞行器轨迹跟踪控制器设计

doi:10.12305/j.issn.1001-506X.2022.08.24

摘要/Abstract

摘要：

针对多种扰动作用下的固定翼飞行器三维轨迹跟踪问题, 设计了一种基于改进非线性扰动观测器的非奇异快速终端滑模轨迹跟踪控制器。首先推导固定翼飞行器三维轨迹跟踪误差模型, 考虑模型误差和飞行过程中的未知扰动, 设计了一种基于状态估计误差反馈的非线性扰动观测器对扰动进行观测。基于非奇异快速终端滑模控制方法, 采用双幂次趋近律设计轨迹跟踪控制器, 并证明了闭环控制系统的稳定性。仿真结果表明, 在多种扰动的作用下, 所设计的轨迹跟踪控制器能够对三维机动轨迹进行准确、稳定的跟踪。

关键词: 轨迹跟踪, 扰动观测器, 终端滑模, 双幂次趋近律, 固定翼飞行器

Abstract:

Aiming at the tracking of the three-dimensional trajectory of fixed-wing aircraft under various disturbances, a non-singular fast terminal sliding mode (TSM) trajectory tracking controller based on an improved nonlinear disturbance observer is proposed. Firstly, a three-dimensional trajectory tracking error model of the fixed-wing aircraft is derived. Considering the model error and the unknown disturbance during the flight, a nonlinear disturbance observer based on state estimation error feedback is designed to observe disturbances. Based on the non-singular fast TSM control method, the trajectory tracking controller is designed with the double power reaching law, and the stability of the closed-loop control system is proved. Simulation results show that the designed trajectory tracking controller can accurately and stably track the three-dimensional maneuvering trajectory under various disturbances.

Key words: trajectory tracking, disturbance observer, terminal sliding mode (TSM), double power reaching law, fixed-wing aircraft

中图分类号:

TJ765

李传旭, 孟秀云, 王捷. 基于扰动观测器的飞行器轨迹跟踪控制器设计[J]. 系统工程与电子技术, 2022, 44(8): 2593-2600.

Chuanxu LI, Xiuyun MENG, Jie WANG. Design of aircraft trajectory tracking controller based on disturbance observer[J]. Systems Engineering and Electronics, 2022, 44(8): 2593-2600.

图/表 7

图1

图2

图3

图4

图5

图6

图7

参考文献 30

1	RAO D M K K V , GO T H . Optimization, stability analysis, and trajectory tracking of perching maneuvers[J]. Journal of Guidance, Control, and Dynamics, 2014, 37 (3): 879- 888. doi: 10.2514/1.60787
2	GREATWOOD C , WALDOCK A , RICHARDSON T . Perched landings manoeuvres with a variable sweep wing UAV[J]. Aero-space Science and Technology, 2017, 71, 510- 520. doi: 10.1016/j.ast.2017.09.034
3	PARK S . Control and guidance for precision deep stall landing[J]. Journal of Guidance, Control, and Dynamics, 2020, 43 (2): 365- 372. doi: 10.2514/1.G004058
4	XU H , IOANNOU P A , MIRMIRANI M . Adaptive sliding mode control design for a hypersonic flight vehicle[J]. Journal of Guidance, Control, and Dynamics, 2004, 27 (5): 829- 838. doi: 10.2514/1.12596
5	LU P. Regulation about time-varying trajectories: precision entry guidance illustrated[C]//Proc. of the AIAA Guidance, Navigation, and Control Conference & Exhibit, 2012.
6	AGUIAR A P , HESPANHA J P . Trajectory-tracking and path-following of underactuated autonomous vehicles with parametric modeling uncertainty[J]. IEEE Trans.on Automatic Control, 2007, 52 (8): 1362- 1379. doi: 10.1109/TAC.2007.902731
7	MEDAGODA E , GIBBENS P W . Synthetic-waypoint guidance algorithm for following a desired flight trajectory[J]. Journal of Guidance, Control, and Dynamics, 2015, 33 (2): 601- 606.
8	ZHANG J M , LI Q , CHENG N , et al. Path-following control for fixed-wing unmanned aerial vehicles based on a virtual target[J]. Proceedings of the Institution of Mechanical Engineers Part G Journal of Aerospace Engineering, 2014, 228 (1): 66- 76. doi: 10.1177/0954410012467716
9	WANG J , MENG X Y , WU G H . Path following of the autonomous airship with compensation of unknown wind and modeling uncertainties[J]. Aerospace Science and Technology, 2019, 93 (10): 105349.
10	RATNOO A , HAYOUN S Y , GRANOT A , et al. Path following using trajectory shaping guidance[J]. Journal of Guidance, Control, and Dynamics, 2014, 38 (1): 106- 116.
11	PARK S , DEYST J , HOW J P . Performance and Lyapunov stability of a nonlinear path-following guidance method[J]. Journal of Guidance, Control, and Dynamics, 2007, 30 (6): 1718- 1728. doi: 10.2514/1.28957
12	NAMHOON C , YOUDAN K , PARK S . Three dimensional nonlinear differential geometric path-following guidance law[J]. Journal of Guidance, Control, and Dynamics, 2015, 38 (12): 2366- 2385. doi: 10.2514/1.G001060
13	WANG X , CAI L B , KONG L X , et al. Path following and obstacle avoidance for unmanned aerial vehicles using a virtual-force-based guidance law[J]. Applied Sciences, 2021, 11 (10): 4618. doi: 10.3390/app11104618
14	陈琦, 王旭刚. 非奇异快速终端滑模及动态面控制的轨迹跟踪制导律[J]. 国防科技大学学报, 2020, 42 (1): 91- 100.
	CHEN Q , WANG X G . Trajectory tracking using nonsingular fast terminal sliding mode control and dynamic surface control[J]. Journal of National University of Defense Technology, 2020, 42 (1): 91- 100.
15	LI C Y , JING W X . Application of PID controller to 2D diffe-rential geometric guidance problem[J]. Journal of Control Theory and Applications, 2007, (5): 285- 290.
16	王无天, 何真, 岳珵. 飞行器栖落机动的轨迹跟踪控制及吸引域优化计算[J]. 北京航空航天大学学报, 2021, 47 (2): 414- 423.
	WANG W T , HE Z , YUE C . Trajectory tracking control and optimal computation of attraction domain for aircraft in perching maneuvers[J]. Journal of Beijing University of Aeronautics and Astronautics, 2021, 47 (2): 414- 423.
17	YANG K , KANG Y , SUKKARIEH S . Adaptive nonlinear model predictive path-following control for a fixed-wing unmanned aerial vehicle[J]. International Journal of Control, Auto-mation and Systems, 2013, 11 (1): 65- 74. doi: 10.1007/s12555-012-0028-y
18	STASTNY T J, DASH A, SIEGWART R. Nonlinear MPC for fixed-wing UAV trajectory tracking: implementation and flight experiments[C]//Proc. of the AIAA Guidance, Navigation, and Control Conference, 2017.
19	EMAMI S A , BANAZADEH A . Simultaneous trajectory tracking and aerial manipulation using a multi-stage model predictive control[J]. Aerospace Science and Technology, 2021, 112 (2): 106573.
20	王晓海, 孟秀云, 李传旭. 基于MPC的无人机航迹跟踪控制器设计[J]. 系统工程与电子技术, 2021, 43 (1): 191- 198.
	WANG X H , MENG X Y , LI C X . Design of trajectory tracking controller for UAV based on MPC[J]. Systems Engineering and Electronics, 2021, 43 (1): 191- 198.
21	MANZOOR T , XIA Y Q , ZHAI D H , et al. Trajectory tracking control of a VTOL unmanned aerial vehicle using offset-free tracking MPC[J]. Chinese Journal of Aeronautics, 2020, 33 (7): 2024- 2042. doi: 10.1016/j.cja.2020.03.003
22	YANG Y N . Positioning control for stratospheric satellites subject to dynamics uncertainty and input constraints[J]. Aerospace Science and Technology, 2019, 86, 534- 541. doi: 10.1016/j.ast.2019.01.045
23	张大元, 雷虎民, 吴玲, 等. 基于滑模变结构的弹道跟踪制导律设计[J]. 系统工程与电子技术, 2014, 36 (4): 721- 727.
	ZHANG D Y , LEI H M , WU L , et al. A trajectory tracking guidance law based on sliding mode variable structure control[J]. Systems Engineering and Electronics, 2014, 36 (4): 721- 727.
24	CHEN W , WEI Y H , ZENG J H , et al. Adaptive terminal sliding mode NDO-based control of underactuated AUV in vertical plane[J]. Discrete Dynamics in Nature and Society, 2016, 2016, 6590517.
25	LIU S Q , SANG Y J , WHIBORNE J F . Adaptive sliding-mode-backstepping trajectory tracking control of underactuated airships[J]. Aerospace Science and Technology, 2020, 97, 105610. doi: 10.1016/j.ast.2019.105610
26	李升波, 李克强, 王建强, 等. 非奇异快速的终端滑模控制方法及其跟车控制应用[J]. 控制理论与应用, 2010, 27 (5): 543- 550.
	LI S B , LI K Q , WANG J Q , et al. Nonsingular fast terminal-sliding-mode control method and its application on vehicular following system[J]. Control Theory and Applications, 2010, 27 (5): 543- 550.
27	华玉龙, 孙伟, 迟宝山, 等. 非奇异快速终端滑模控制[J]. 系统工程与电子技术, 2017, 39 (5): 1119- 1125.
	HUA Y L , SUN W , CHI B S , et al. Study on nonsingular fast terminal sliding mode control[J]. Systems Engineering and Electronics, 2017, 39 (5): 1119- 1125.
28	CHEN W H . Nonlinear disturbance observer-enhanced dynamic inversion control of missiles[J]. Journal of Guidance, Control, and Dynamics, 2003, 26 (1): 161- 166. doi: 10.2514/2.5027
29	张合新, 范金锁, 孟飞, 等. 一种新型滑模控制双幂次趋近律[J]. 控制与决策, 2013, 28 (2): 289- 293.
	ZHANG H X , FAN J S , MENG F , et al. A new double power reaching law for sliding mode control[J]. Control and Decision, 2013, 28 (2): 289- 293.
30	BHAT S P , BERNSTEIN D S . Finite-time stability of continuous autonomous systems[J]. SIAM Journal on Control and Optimization, 2000, 38 (3): 751- 766. doi: 10.1137/S0363012997321358

[1]	汤新民, 郑鹏程. 基于大地坐标系的IMM航空器短期航迹外推[J]. 系统工程与电子技术, 2022, 44(7): 2293-2301.
[2]	曹晓明, 魏勇, 衡辉, 沈智鹏. 海流扰动下无人水下航行器的动态面反演轨迹跟踪控制[J]. 系统工程与电子技术, 2021, 43(6): 1664-1672.
[3]	郭佳晖, 蒋滨安, 田宗浩. 带有攻击角和视场角约束的制导炮弹导引律设计[J]. 系统工程与电子技术, 2021, 43(4): 1050-1056.
[4]	李军, 廖宇新, 李珺. 三维自适应有限时间超螺旋滑模制导律[J]. 系统工程与电子技术, 2021, 43(3): 779-788.
[5]	杨宇, 吴达, 高峰, 邓建军. 适用于超低空拦截的复合制导律设计方法[J]. 系统工程与电子技术, 2021, 43(1): 208-215.
[6]	王成, 王旭刚. 高超声速制导炮弹终端滑模控制[J]. 系统工程与电子技术, 2020, 42(12): 2859-2866.
[7]	景亮, 张忠阳, 崔乃刚, 吴荣. 固定时间收敛扰动观测终端滑模制导律设计[J]. 系统工程与电子技术, 2019, 41(8): 1820-1826.
[8]	傅江良, 甘庆波, 张扬, 赵柯昕, 袁洪. 基于NTSM的航天器特征点凝视跟踪控制[J]. 系统工程与电子技术, 2019, 41(7): 1623-1632.
[9]	郑世钰, 艾晓琳, 杨迪, 贾振岳, 于剑桥. 基于积分反步法的四旋翼滑模轨迹跟踪算法[J]. 系统工程与电子技术, 2019, 41(3): 643-650.
[10]	沈智鹏, 毕艳楠, 郭坦坦, 王茹. 带非线性观测器的欠驱动船舶自适应动态面输出反馈轨迹跟踪控制[J]. 系统工程与电子技术, 2019, 41(2): 409-415.
[11]	吴鹏飞, 石章松, 吴中红, 王智. 无人直升机自主着舰轨迹跟踪控制[J]. 系统工程与电子技术, 2019, 41(11): 2573-2580.
[12]	吴放, 常思江, 陈升富. 基于终端滑模理论的攻击时间控制制导律[J]. 系统工程与电子技术, 2019, 41(10): 2334-2342.
[13]	陈峰, 何广军, 熊思宇. 考虑布儒斯特角约束的复合积分制导律设计[J]. 系统工程与电子技术, 2018, 40(8): 1824-1831.
[14]	晁涛, 王雨潇, 王松艳, 杨明. 考虑非最小相位特性的高超声速飞行器轨迹跟踪控制[J]. 系统工程与电子技术, 2018, 40(7): 1548-1553.
[15]	王坚浩, 胡剑波, 张亮, 张鹏涛, 宋敏. 基于滑模干扰观测器的反演终端滑模飞行控制[J]. 系统工程与电子技术, 2018, 40(6): 1345-1350.