基于罚函数序列凸规划的多无人机轨迹规划

doi:10.7527/S1000-6893.2016.0064

电子与控制

本期目录 | 过刊浏览 | 高级检索

前一篇 | 后一篇

基于罚函数序列凸规划的多无人机轨迹规划

王祝^1,2, 刘莉^1,2, 龙腾^1,2, 温永禄^1,2

1. 飞行器动力学与控制教育部重点实验室, 北京 100081;
2. 北京理工大学宇航学院, 北京 100081

收稿日期:2015-11-11 修回日期:2016-01-22 出版日期:2016-10-15 发布日期:2016-03-07
通讯作者: 刘莉,Tel.:010-68914534 E-mail:liuli@bit.edu.cn E-mail:liuli@bit.edu.cn
作者简介:王祝男,博士研究生。主要研究方向:无人机任务规划、无人机协同决策与控制。Tel:010-68913290 E-mail:wangzhubit@163.com;刘莉女,博士,教授,博士生导师。主要研究方向:飞行器总体设计、飞行器结构设计、多学科设计优化。Tel:010-68914534 E-mail:liuli@bit.edu.cn
基金资助:
国家自然科学基金（11372036，51105040）；航空科学基金（2015ZA72004）

Trajectory planning for multi-UAVs using penalty sequential convex pro-gramming

WANG Zhu^1,2, LIU Li^1,2, LONG Teng^1,2, WEN Yonglu^1,2

1. Key Laboratory of Dynamics and Control of Flight Vehicle, Ministry of Education, Beijing 100081, China;
2. School of Aerospace Engineering, Beijing Institute of Technology, Beijing 100081, China

Received:2015-11-11 Revised:2016-01-22 Online:2016-10-15 Published:2016-03-07
Supported by:
National Natural Science Foundation of China (11372036; 51105040); Aeronautical Science Foundation of China (2015ZA72004)

摘要/Abstract

摘要：

多无人机（UAVs）轨迹规划是具有非线性运动约束和非凸路径约束的最优控制问题。引入序列凸规划思想，将非凸最优控制问题近似为一系列凸优化子问题，并利用成熟的凸优化算法进行求解，以更好地权衡最优性和时效性。首先，建立了多无人机协同轨迹规划的非凸最优控制模型。然后，利用离散化和凸近似方法将其转换为凸优化问题，包括对无人机运动模型的线性化，以及对威胁规避约束和无人机碰撞约束的凸化。同时，提出了一种离散点间的威胁规避方法，保证无人机在离散轨迹点间的飞行安全。在凸优化模型的基础上，给出了基于罚函数序列凸规划求解多无人机轨迹规划的具体框架。最后，通过数值仿真验证了方法的有效性，结果表明该方法在多机轨迹规划结果的最优性和时效性都要优于伪谱法，而且优势随编队数量的增加而增大。

关键词: 无人机, 轨迹规划, 碰撞规避, 最优控制, 凸规划

Abstract:

Trajectory planning of multiple unmanned aerial vehicles (UAVs) is an optimal control problem which subjects to nonlinear motion and nonconvex path constraints. Based on the sequential convex programming approach, such nonconvex optimal control is approximated to be a series of convex optimization subproblems, which can be solved by the state-of-the-art convex optimization algorithm. A good balance between solution quality and computational tractability can then be achieved. Nonconvex optimal control model for multi-UAV trajectory planning is formulated first, and is then approximated to be a convex optimization by discretization and convexification methods. To convexify the nonconvex model, equations of motion of UAVs are linearized, and constraints of threat avoidance and inter-UAVs collision avoidance are convexified. Meanwhile, an inter-sample threat avoidance method is provided to guarantee UAVs' safety at intervals between discrete trajectory points. Based on convex optimization formulation, the detailed procedure of using sequential convex programming based on penalty function to solve multi-UAV trajectory planning is provided. Numerical simulations are conducted to show the effectiveness of the proposed method. The results show that the method can acquire the solution with better optimality and efficiency than the pseudospectral method, especially for larger scale UAV formation.

Key words: unmanned aerial vehicle, trajectory planning, collision avoidance, optimal control, convex programming

中图分类号:

V279

王祝, 刘莉, 龙腾, 温永禄. 基于罚函数序列凸规划的多无人机轨迹规划[J]. 航空学报, 2016, 37(10): 3149-3158.

WANG Zhu, LIU Li, LONG Teng, WEN Yonglu. Trajectory planning for multi-UAVs using penalty sequential convex pro-gramming[J]. ACTA AERONAUTICAET ASTRONAUTICA SINICA, 2016, 37(10): 3149-3158.

参考文献

[1] 沈林成, 牛轶峰, 朱华勇, 等. 多无人机自主协同控制理论与方法[M]. 北京:国防工业出版社, 2013:1-9. SHEN L C, NIU Y F, ZHU H Y, et al. Theories and methods of autonomous cooperative control for multiple UAVs[M]. Beijing:National Defense Industry Press, 2013:1-9(in Chinese).
[2] 丁明跃, 郑昌文, 周成平, 等. 无人飞行器航迹规划[M]. 北京:电子工业出版社, 2009:6-15. DING M Y, ZHENG C W, ZHOU C P, et al. Route planning for unmanned aerial vehicles[M]. Beijing:Publishing House of Electronics industry, 2009:6-15(in Chinese).
[3] 张煜, 张万鹏, 陈璟, 等. 基于Gauss伪谱法的UCAV对地攻击武器投放轨迹规划[J]. 航空学报, 2011, 32(7):1240-1251. ZHANG Y, ZHANG W P, CHEN J, et al. Air-to-ground weapon delivery trajectory planning for UCAVs using Gauss pseudospectral method[J]. Acta Aeronautica et Astronautica Sinica, 2011, 32(7):1240-1251(in Chinese).
[4] 白瑞光, 孙鑫, 陈秋双, 等. 基于Gauss伪谱法的多UAV协同航迹规划[J]. 宇航学报, 2014, 35(9):1022-1029. BAI R G, SUN X, CHEN Q S, et al. Multiple UAV cooperative trajectory planning based on Gauss pseudospectral method[J]. Journal of Astronautics, 2014, 35(9):1022-1029(in Chinese).
[5] RICHARDS A, HOW J P. Aircraft trajectory planning with collision avoidance using mixed integer linear programming[C]//Proceedings of the American Control Conference. Reston:AIAA, 2002:1936-1941.
[6] KUWATA Y, HOW J P. Cooperative distributed robust trajectory optimization using receding horizon MILP[J]. IEEE Transactions on System Technology, 2011, 19(2):423-431.
[7] 熊伟, 陈宗基, 周锐. 运用混合遗传算法的多机编队重构优化方法[J]. 航空学报, 2008, 29(S1):209-214. XIONG W, CHEN Z J, ZHOU R. Optimization of multiple flight vehicle formation reconfiguration using hybrid genetic algorithm[J]. Acta Aeronautica et Astronautica Sinica, 2008, 29(S1):209-214(in Chinese).
[8] DUAN H B, LIU S Q, WU J. Novel intelligent water drops optimization approach to single UCAV smooth trajectory planning[J]. Aerospace Science and Technology, 2009, 13(8):442-449.
[9] BOYD S, VANDENBERGHE L. Convex optimization[M]. New York:Cambridge University Press, 2004:1-15.
[10] BYRD R H, GILBERT J C, NOCEDAL J. A trust region method based on interior point techniques for nonlinear programming[J]. Mathematical Programming, 2000, 89(1):149-185.
[11] LIU X F, LU P. Solving nonconvex optimal control problems by convex optimization[J]. Journal of Guidance, Control, and Dynamics, 2014, 37(3):750-765.
[12] LU P, LIU X F. Autonomous trajectory planning for rendezvous and proximity operations by conic optimization[J]. Journal of Guidance, Control, and Dynamics, 2013, 36(2):375-389.
[13] LIU X F, SHEN Z J, LU P. Entry trajectory optimization by second-order cone programming[J]. Journal of Guidance, Control, and Dynamics, 2016, 39(2):227-241.
[14] LIU X F, SHEN Z J, LU P. Solving the maximum-crossrange problem via successive second-order cone programming with a line search[J]. Aerospace Science and Technology, 2015, 47:10-20.
[15] MORGAN D, CHUNG S. Model predictive control of swarm of spacecraft using sequential convex programming[J]. Journal of Guidance, Control, and Dynamics, 2014, 37(6):1725-1740.
[16] AUGUGLIARO F, SCHOELLIG A P, D'ANDREA R. Generation of collision-free for a quadrocopter fleet:a sequential convex programming approach[C]//IEEE/RSJ International Conference on Intelligent Robots and Systems. Piscataway, NJ:IEEE Press, 2012:1917-1922.
[17] CHEN Y F, CUTLER M, HOW J P. Decoupled multiagent path planning via incremental sequential convex programming[C]//IEEE International Conference on Robotics and Automation. Piscataway, NJ:IEEE Press, 2015:5954-5961.
[18] KABAMBA P T, MEERKOV S M, ZEITZ F H. Optimal path planning for unmanned combat aerial vehicles to defeat radar tracking[J]. Journal of Guidance, Control, and Dynamics, 2006, 29(2):279-288.
[19] MAIA M H, GALVAO R K H. On the use of mixed-integer linear programming for predictive control with avoidance constraints[J]. International Journal of Robust and Nonlinear Control, 2009, 19(7):822-828.
[20] RICHARDS A, TURNBULL O. Inter-sample avoidance in trajectory optimizers using mixed-integer linear programming[J]. International Journal of Robust and Nonlinear Control, 2015, 25(4):521-526.
[21] CVX Research Inc. CVX:Matlab software for disciplined convex programming, version 2.0[EB/OL]. (2011-06-17)[2015-10-09]. http://cvxr.com/cvx.
[22] GRANT M AND BOYD S. Graph implementations for nonsmooth convex programs[M]//Blondel V, Boyd S, and Kimura H. Recent Advances in Learning and Control. Berlin:Springer, 2008:95-110.
[23] TUTUNCU R H, TOH K C, TODD M J. Solving semidefinite-quadratic-linear programs using SDPT3[J]. Mathematical Programming, Series B, 2003, 95(2):189-217.
[24] PATTERSON M A, RAO A V. GPOPS-Ⅱ:A matlab software for solving multiple-phase optimal control problems using hp-adaptive gaussian quadrature collocation methods and sparse nonlinear programming[J]. ACM Transactions on Mathematical Software, 2014, 41(1):1-37.

E-mail：hkxb@buaa.edu.cn

关于我们

期刊社服务

专业学科

封面文章

友情链接

主管单位：中国科学技术协会主办单位：中国航空学会北京航空航天大学

基于罚函数序列凸规划的多无人机轨迹规划

Trajectory planning for multi-UAVs using penalty sequential convex pro-gramming

PDF (PC)

可视化

摘要/Abstract

引用本文

使用本文

参考文献

相关文章 15

编辑推荐

Metrics

本文评价

[1]	王海峰, 刘坤澎, 江泓鑫, 杜晨曦. 螺旋桨多设计点气动优化方法和变桨距角策略[J]. 航空学报, 2024, 45(9): 528831-528831.
[2]	赵春晖, 刘安萌, 吕洋, 潘泉. 无人机韧性自主定位技术综述[J]. 航空学报, 2024, 45(8): 28839-028839.
[3]	张薇, 何若俊. 面向物联网数据收集的无人机自主路径规划[J]. 航空学报, 2024, 45(8): 329054-329054-1.
[4]	王传云, 苏阳, 王琳霖, 王田, 王静静, 高骞. 面向反制无人机集群的多目标连续鲁棒跟踪算法[J]. 航空学报, 2024, 45(7): 329017-329017.
[5]	赵靖, 宋丹. 无人机GNSS/IMU组合导航系统完好性监测方法[J]. 航空学报, 2024, 45(7): 328943-328943.
[6]	尹洪玉, 吴宇, 梁天骄. 固定翼无人机巡逻覆盖协同路径规划方法[J]. 航空学报, 2024, 45(6): 328944-328944.
[7]	罗旭东, 吴一全, 陈金林. 无人机航拍影像目标检测与语义分割的深度学习方法研究进展[J]. 航空学报, 2024, 45(6): 28822-028822.
[8]	安朝, 霍贵玺, 孟杨, 谢长川, 杨超. 翼尖铰接组合式无人机气动建模方法及布局参数影响[J]. 航空学报, 2024, 45(6): 629587-629587.
[9]	李广佳, 王红波, 张凯, 仪志胜. 临近空间太阳能无人机增升减阻技术综述[J]. 航空学报, 2024, 45(5): 529644-529644.
[10]	蔡云鹏, 周大鹏, 丁江川. 具有防撞安全约束的无人机集群智能协同控制[J]. 航空学报, 2024, 45(5): 529683-529683.
[11]	王祝, 张梦通, 张振鹏, 徐广通. 基于多指标动态优先级的无人机协同路径规划[J]. 航空学报, 2024, 45(4): 328816-328816.
[12]	郑高杰, 何小明, 李东坡, 谭慧俊, 汪昆, 吴祯龙, 王德鹏. 尾部推进无人机双90°偏折进气道/蜗壳耦合流动特性[J]. 航空学报, 2024, 45(4): 128782-128782.
[13]	杨加秀, 李新凯, 张宏立, 王昊. 切换拓扑下异构集群的强化学习时变编队控制[J]. 航空学报, 2024, 45(10): 329166-329166.
[14]	张清瑞, 刘赟韵, 孙慧杰, 朱波. 固定翼无人机紧密编队的鲁棒协同跟踪控制[J]. 航空学报, 2024, 45(1): 629233-629233.
[15]	董豪泽, 陈昱达, 刘丹, 李忠奎. 障碍物空间下分布式轨迹规划的死锁破解[J]. 航空学报, 2023, 44(S2): 729771-729771.