未知风场扰动下无人机三维航迹跟踪鲁棒最优控制

张坤; 高晓光

doi:10.11999/JEIT150047

未知风场扰动下无人机三维航迹跟踪鲁棒最优控制

doi: 10.11999/JEIT150047

张坤¹,
高晓光¹

基金项目:

国家自然科学基金(60774064)和教育部博士点基金(20116102110026)

计量
- 文章访问数: 1425
- HTML全文浏览量: 140
- PDF下载量: 919
- 被引次数: 0
出版历程
- 收稿日期: 2015-01-07
- 修回日期: 2015-08-02
- 刊出日期: 2015-12-19

Robust Optimal Control for Unmanned Aerial Vehicles Three-dimensional Trajectory Tracking in Wind Disturbance

Zhang Kun¹,
Gao Xiao-guang¹

Funds:

The National Natural Science Foundation of China (60774064)

摘要

摘要: 该文提出一种未知风场扰动下无人机精确3维航路跟踪的鲁棒最优控制律。该控制律基于跟踪虚拟目标的思想，将风场扰动加入无人机运动方程，采用反馈线性化将无人机的非线性动力学方程变换为线性状态方程。假设风场扰动已知的条件下，采用线性二次型调节器推导出能够跟踪3维航路的最优控制律。进一步考虑未知的风场扰动，设计鲁棒控制项代替最优控制律中的风场参数，得到能够抑制未知有界风场干扰的鲁棒最优控制律，并采用Lyapunov稳定性理论证明该闭环系统的全局渐近稳定性。仿真表明该控制律能够实现在未知风场扰动下无人机精确3维航迹跟踪，且具有良好的跟踪性能。
- 3维航迹跟踪 /
- 最优控制 /
- 鲁棒控制 /
- 风场扰动
Abstract: This paper presents a robust optimal guidance control law for precise three-dimensional (3D) trajectory tracking of an Unmanned Aerial Vehicle (UAV) in wind disturbance. The wind disturbance is considered in the UAVs kinematic model. The reference path is considered as a trajectory of a virtual target. Feedback linearization is used to transform the nonlinear dynamics of the UAV to linear state equations. Based on the assumption that the wind disturbance can be known precisely, an optimal control law is derived for the UAV's 3D trajectory tracking using the LQR (Linear Quadratic Regulator). Then considering the unknown wind disturbance, a robust term is designed to replace the unknown wind disturbance, and a robust optimal control law is obtained. Global asymptotic stability of the closed-loop system is proved by Lyapunov stability theory. Simulations show that the proposed control law can achieve precise 3D UAV trajectory tracking with wind disturbance attenuation, and has good tracking performance.
- 3D trajectory tracking /
- Optimal control /
- Robust control /
- Winds disturbance

HTML全文

参考文献(32)

Cho A, Kim J, Lee S, et al.. Wind estimation and airspeed calibration using a UAV with a single-antenna GPS receiver and pitot tube[J]. IEEE Transactions on Aerospace and Electronic Systems, 2011, 47(1): 109-117.

Nelson D R, Barber D B, Mclain T W, et al.. Vector field path following for miniature air vehicles[J]. IEEE Transactions on Robotics, 2007, 23(3): 519-529.

雷旭升, 陶冶. 小型无人飞行器风场扰动自适应控制方法[J]. 航空学报, 2010, 31(6): 1171-1176.

Lei X S and Tao Y. Adaptive control for small unmanned aerial vehicle under wind disturbance[J]. Acta Aeronautica et Astronautica Sinica, 2010, 31(6): 1171-1176.

Rysdyk R. Unmanned aerial vehicle path following for target observation in wind[J]. Journal of Guidance, Control, and Dynamics, 2006, 29(5): 1092-1100.

Ragi S and Edwin C. UAV path planning in a dynamic environment via partially observable markov decision process [J]. IEEE Transactions on Aerospace and Electronic Systems, 2013, 49(4): 2397-2412.

Ailliot P, Monbet V, and Prevosto M. An autoregressive model with time-varying coefficients for wind fields[J]. Environmetrics, 2006, 17(2): 107-117.

Langelaan J W, Alley N, and Neidhoefer J. Wind field estimation for small unmanned aerial vehicles[J]. Journal of Guidance, Control, and Dynamics, 2011, 34(4): 1016-1030.

De Jong P M A, Laan J J, Veld A C, et al.. Wind-profile estimation using airborne sensors[J]. Journal of Aircraft, 2014, 51(6): 1852-1863.

Mcgee T G and Hedrick J K. Path planning and control for multiple point surveillance by an unmanned aircraft in wind[C]. 2006 American Control Conference, Minneapolis, MN, United States, 2006: 4261-4266.

Celentano L. Robust tracking method for uncertain MIMO systems of realistic trajectories[J]. Journal of the Franklin Institute, 2013, 350(3): 437-451.

Ouyang P R, Acob J, and Pano V. PD with sliding mode control for trajectory tracking of robotic system[J]. Robotics and Computer-Integrated Manufacturing, 2014, 30(2): 189-200.

Sabanovic A. Variable structure systems with sliding modes in motion control-a survey[J]. IEEE Transactions on Industrial Informatics, 2011, 7(2): 212-223.

Park S, Deyst J, and 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.

Kothari M, Postlethwaite I, and Gu D W. UAV path following in windy urban environments[J]. Journal of Intelligent Robotic Systems, 2014, 74(3-4): 1013-1028.

贺跃帮, 裴海龙, 叶祥, 等. 无人直升机的自适应动态面轨迹跟踪控制[J]. 华南理工大学学报(自然科学版), 2013, 41(5): 1-8.

He Y B, Pei H L, Ye X, et al.. Trajectory tracking control of unmanned helicopters by using adaptivedynamic surface approach[J]. Journal of South China University of Technology (Natural Science Edition), 2013, 41(5): 1-8.

王怿, 祝小平, 周洲, 等. 3维动态环境下的无人机路径跟踪算法[J]. 机器人, 2014, 36(1): 83-91.

Wang Y, Zhu X P, Zhou Z, et al.. UAV path following in 3-D dynamic environment[J]. ROBOT, 2014, 36(1): 83-91.

黄静, 刘刚, 马广富. 含不确定性的绳系卫星姿态的鲁棒最优控制[J]. 宇航学报, 2012, 33(10): 1423-1431.

Huang J, Liu G, and Ma G F. Nonlinear robust optimal attitude tracking of tethered satellite system with uncertainties[J]. Journal of Astronautics, 2012, 33(10): 1423-1431.

贾鹤鸣, 张利军, 程相勤, 等. 基于非线性迭代滑模的欠驱动UUV三维航迹跟踪控制[J]. 自动化学报, 2012, 38(2): 308-314.

Jia H M, Zhang L J, Cheng X Q, et al.. Three-dimensional path following control for an underactuated UUV based on nonlinear iterative sliding mode[J]. Acta Automatica Sinica, 2012, 38(2): 308-314.

El-Ferik S, Qureshi A, and Lewis F L. Neuro-adaptive cooperative tracking control of unknown higher-order affine nonlinear systems[J]. Automatica, 2014, 50(3): 798-808.

Bugajski D J and Enns D F. Nonlinear control law with application to high angle-of-attack flight[J]. Journal of Guidance, Control, and Dynamics, 1992, 15(3): 761-767.

陈晓岑, 周东华, 陈茂银. 基于逆系统方法的DGMSCMG框架伺服系统解耦控制研究[J]. 自动化学报, 2013, 39(5): 502-509.

Chen X C, Zhou D H, and Chen M Y. Decoupling control of the gimbal servo system of the DGMSCMG based on the dynamic inverse system method[J]. Acta Automatica Sinica, 2013, 39(5): 502-509.

Snell S A, Nns D F, and Arrard W L. Nonlinear inversion flight control for a supermaneuverable aircraft[J]. Journal of Guidance, Control, and Dynamics, 1992, 15(4): 976-984.

Khalil H K. Nonlinear Systems[M]. Upper Saddle River: Prentice Hall, 2002: 126-132.

Park S. Autonomous aerobatics on commanded path[J]. Aerospace Science and Technology, 2012, 22(1): 64-74.

Cabecinhas D, Cunha R, and Silvestre C. A nonlinear quadrotor trajectory tracking controller with disturbance rejection[J]. Control Engineering Practice, 2014, 26: 1-10.

施引文献

资源附件(0)

访问统计