CN113050687B - 一种多无人机编队重组轨迹规划方法 - Google Patents

一种多无人机编队重组轨迹规划方法 Download PDF

Info

Publication number
CN113050687B
CN113050687B CN202110297086.9A CN202110297086A CN113050687B CN 113050687 B CN113050687 B CN 113050687B CN 202110297086 A CN202110297086 A CN 202110297086A CN 113050687 B CN113050687 B CN 113050687B
Authority
CN
China
Prior art keywords
unmanned aerial
constraint
max
formation
state
Prior art date
Legal status (The legal status is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the status listed.)
Active
Application number
CN202110297086.9A
Other languages
English (en)
Other versions
CN113050687A (zh
Inventor
宁召柯
李彬
刘高旗
马巍
余琪
朱勃帆
魏钰良
Current Assignee (The listed assignees may be inaccurate. Google has not performed a legal analysis and makes no representation or warranty as to the accuracy of the list.)
Sichuan University
Original Assignee
Sichuan University
Priority date (The priority date is an assumption and is not a legal conclusion. Google has not performed a legal analysis and makes no representation as to the accuracy of the date listed.)
Filing date
Publication date
Application filed by Sichuan University filed Critical Sichuan University
Priority to CN202110297086.9A priority Critical patent/CN113050687B/zh
Publication of CN113050687A publication Critical patent/CN113050687A/zh
Application granted granted Critical
Publication of CN113050687B publication Critical patent/CN113050687B/zh
Active legal-status Critical Current
Anticipated expiration legal-status Critical

Links

Images

Classifications

    • G—PHYSICS
    • G05—CONTROLLING; REGULATING
    • G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
    • G05D1/00—Control of position, course, altitude or attitude of land, water, air or space vehicles, e.g. using automatic pilots
    • G05D1/10—Simultaneous control of position or course in three dimensions
    • G05D1/101—Simultaneous control of position or course in three dimensions specially adapted for aircraft
    • G05D1/104—Simultaneous control of position or course in three dimensions specially adapted for aircraft involving a plurality of aircrafts, e.g. formation flying

Landscapes

  • Engineering & Computer Science (AREA)
  • Aviation & Aerospace Engineering (AREA)
  • Radar, Positioning & Navigation (AREA)
  • Remote Sensing (AREA)
  • Physics & Mathematics (AREA)
  • General Physics & Mathematics (AREA)
  • Automation & Control Theory (AREA)
  • Traffic Control Systems (AREA)

Abstract

本发明公开了一种多无人机编队重组轨迹规划方法，首先建立包含动力学方程、通信距离约束条件、机动性能约束条件、安全距离约束、终端队形约束的多固定翼无人机编队重组问题的非线性最优控制模型；其次应用精准罚函数方法，针对非线性状态等式及不等式约束，将P0问题进一步处理为问题P1；最后应用hp自适应伪谱法将问题P1转化为非线性规划问题进行求解。与现有技术相比，本发明在解决多无人机编队重组轨迹优化问题时，与启发式算法相比，具有更快的收敛速度；与一般的hp自适应伪谱法相比，能够处理约束维度爆炸的问题，在不影响优化最优性的基础上，减小计算量，加快收敛速度。

Description

一种多无人机编队重组轨迹规划方法
技术领域
本发明涉及无人机技术领域，尤其涉及一种多无人机编队重组轨迹规划方法。
背景技术
无人机(UAV)在军事和民用领域具有广泛的应用，例如侦察、精确打击、飞行表演和地质勘测等。这些飞行任务通常需要无人机组改变其编队形状以满足不同任务的需要。因此，多无人机编队重组变得越来越重要。
多无人机编队重组问题，即以某些指标，如时间最快或燃油最省等为目标，求解每个无人机的控制输入，从而在满足某些约束的情况下，例如通信约束、机间防碰撞约束和飞行性能约束等，使多无人机组可以从初始队形重组为所需的新队形。为此，几种方法近年来已被应用于多无人机编队重组问题，例如PID控制[1-2]模型预测控制[3-5]，鲁棒控制[6-8]，滑模控制[9-10]。但这些方法通常将无人机编队重组问题处理为轨迹跟随问题，设计控制器使无人机组强制跟随规划好的航迹。
对于无人机组编队重组问题，可以被视为具有约束的优化问题。由于计算机性能的提高和无人机编队重配置问题的复杂非线性，通常采用数值方法来解决此类问题，主要分为间接方法和直接方法。值得一提的是，还有其他优化方法，例如基于动态规划的方法[11-12]，但当无人机组数量稍多时，动态规划方法将出现高维度灾难问题。通过间接方法，如果考虑无人机系统模型与复杂的代数约束，求解过程将变得复杂，难以求解。因此，直接方法更广泛地用于解决这些问题。通过离散化控制变量和状态变量，直接方法可以将连续时间的最优控制问题转换为有限维的非线性规划问题(NLP)，接下来即设计解决NLP问题的算法。近年来，在研究人员提出的算法中，由于能够跳出局部最优解，启发式算法在无人机组编队重组问题中应用颇多。如Duan等[13]提出了一种改进的粒子群优化(PSO)方法，基于控制参数化的方法，来搜索时间最优编队重组问题的局部和全局最优值。Duan等[14]又混合了粒子群优化算法与遗传算法(HPSOGA)，结合了PSO和GA的优势。但是，在这类方法中，尽管它能够跳出局部最优值，却不能保证收敛到所谓的全局最优值，并且其计算量大。作为直接法,伪谱方法在解决飞行器优化问题有较多应用。例如，张等[15]将hp自适应伪谱方法应用于多四旋翼无人机编队轨迹优化问题。Chai等[16]结合差分进化算法来与hp自适应Radau伪谱方法来处理飞行器再入轨迹优化问题。邵等[17]提出了改进的高斯伪谱法，用于多无人机协同轨迹规划问题。由于多无人机组编队重组问题中，原始系统维度高且需要考虑的约束多，加上伪谱法将原始问题转化为高维度的非线性规划问题，在处理高维度的无人机及无人机间复杂约束时，计算量会较大，收敛速度慢。对于上述方法，现有技术存在一些或多或少的缺点，存在的技术问题有：启发式算法等全局算法计算效率低，且无法保证收敛到全局最优解；一般的伪谱法在处理高维度的无人机及无人机间复杂约束时，计算量会较大，收敛速度慢。
发明内容
本发明为了解决以上问题，提供一种基于精确罚函数及hp自适应Radau伪谱法的多无人机编队重组轨迹优化方法，该方法首先建立包含动力学方程、通信距离约束条件、机动性能约束条件、安全距离约束的多固定翼无人机编队重组问题的非线性最优控制模型；利用hp自适应Radau伪谱法将连续时间的非线性最优控制模型转化为多区间的非线性最优控制模型,基于航迹的曲率密度函数实现伪谱法的自适应配点策略；并利用精准罚函数方法，处理在转化后的非线性规划问题中高维度的无人机及无人机间复杂约束，减小计算量，加快算法收敛速度。
为达到上述目的，本发明是按照以下技术方案实施的：
本发明一种多无人机编队重组轨迹规划方法包括以下步骤：
S1：建立包含动力学方程、通信距离约束条件、机动性能约束条件、安全距离约束、终端队形约束的多固定翼无人机编队重组问题的非线性最优控制模型；
S2：应用精准罚函数方法，针对非线性状态等式及不等式约束，将P0问题进一步处理为问题P1；
S3：应用hp自适应伪谱法将问题P1转化为非线性规划问题进行求解。
本发明的有益效果是：
本发明是一种多无人机编队重组轨迹规划方法，与现有技术相比，本发明在解决多无人机编队重组轨迹优化问题时，与启发式算法相比，具有更快的收敛速度；与一般的hp自适应伪谱法相比，能够处理约束维度爆炸的问题，在不影响优化最优性的基础上，减小计算量，加快收敛速度。
附图说明
图1是无人机群编队重构轨迹图；
图2是无人机群机间距离曲线图；
图3是无人机群推力曲线图；
图4是无人机群过载系数曲线图；
图5是无人机群滚转角曲线图。
具体实施方式
下面结合附图以及具体实施例对本发明作进一步描述，在此发明的示意性实施例以及说明用来解释本发明，但并不作为对本发明的限定。
如图1-5所示：首先建立包含动力学方程、通信距离约束条件、机动性能约束条件、安全距离约束、终端队形约束的多固定翼无人机编队重组问题的非线性最优控制模型。考虑三自由度固定翼无人机制导系统动态方程，
Figure BDA0002984748250000041
Figure BDA0002984748250000042
Figure BDA0002984748250000043
Figure BDA0002984748250000044
Figure BDA0002984748250000045
Figure BDA0002984748250000046
其中i＝1,2,...,N为无人机编号，γ为爬升角，χ为偏航角，μ为滚转角。T为推力，D为阻力，n代表的是无人机的负载系数，之后考虑无人机及及无人机间的通信距离约束条件、机动性能约束条件、安全距离约束、终端队形约束，通信距离及安全距离机间约束：
Dsafe≤di,j(t)≤Dcomm,
Figure BDA0002984748250000047
di,j(t)为任意两家无人机间的距离。
机动性能约束：vmin≤vi≤vmax
χmin≤χi≤χmax
γmin≤γi≤γmax
Tmin≤Ti≤Tmax
Figure BDA0002984748250000048
nmin≤ni≤nmax
假设第N架无人机为队形中心，则终端队形约束为：
hi＝[xi(tf)-xN(tf)-xi,N]2+[yi(tf)-yN(tf)-yi,N]2+[zi(tf)-zN(tf)-zi,N]2＝0
i＝1,2,...,N-1
考虑时间最有编队重组，目标函数可以表达为：
Figure BDA0002984748250000051
至此，多固定翼无人机编队重组问题的非线性最优控制问题可以表示为如下问题P0，
Figure BDA0002984748250000052
Figure BDA0002984748250000053
vmin≤vi≤vmax
γmin≤γi≤γmax
Tmin≤Ti≤Tmax
Figure BDA0002984748250000054
nmin≤ni≤nmax,i＝1,2,…,N
hi＝0,i＝1,2,…,N-1
Dsafe≤di,j(t)≤Dcomm
Figure BDA0002984748250000055
第二部分为应用精准罚函数方法，针对非线性状态等式及不等式约束，将P0问题进一步处理为问题P1，目标函数变为
Figure BDA0002984748250000056
问题P1可以描述如下，
Figure BDA0002984748250000057
Figure BDA0002984748250000058
vmin≤vi≤vmax
γmin≤γi≤γmax
Tmin≤Ti≤Tmax
Figure BDA0002984748250000059
nmin≤ni≤nmax,i＝1,2,…,N
最后应用hp自适应伪谱法将问题P1转化为非线性规划问题进行求解。求解步骤大致为：
1)时间区间转换。假设飞机爬升时间为t∈[t0,tf]，将其分为K份网格区间[tk-1,tk)，k＝1,2,…,K，其中tK＝tf。在每个网格区间t∈[tk-1,tk)内，时间范围可由下式转化为τ∈[-1,1)，
Figure BDA0002984748250000061
2)选择LGR配点。在每个网格区间内选择Mk个LGR配点，通过求解下列Mk阶勒让德方程即可得到配点，
Figure BDA0002984748250000062
其中
Figure BDA0002984748250000063
3)状态和控制变量离散化。连续时间状态和控制变量可由拉格朗日多项式进行插值近似离散化，由于Radau伪谱法中的LGR配点不包括端点，为了保持状态变量在整个时间区间上的连续性以及终端状态值的优化，在每段时间区间上，增加τ＝1的配点，状态量与控制量可以近似为
Figure BDA0002984748250000064
Figure BDA0002984748250000065
其中，Li(τ)为拉格朗日多项式基式。
4)动态方程转换。由上式，状态变量对τ的导数为
Figure BDA0002984748250000066
进而，状态方程可转化为下列代数约束
Figure BDA0002984748250000067
式中，
Figure BDA0002984748250000068
为在第k个时间区间的Radau伪谱微分矩阵。
5)目标函数以及约束近似化。考虑如下Bolza形式的目标函数
Figure BDA0002984748250000071
通过Radau伪谱法，目标函数可以近似为
Figure BDA0002984748250000072
式中
Figure BDA0002984748250000073
为积分权重系数。
将优化问题P1的不等式约束以及等式约束表示为
Figure BDA0002984748250000074
代入近似后的状态以及控制量后，约束可以近似为
Figure BDA0002984748250000075
式中，i＝1,2,…,Mk,k＝1,2,…,K。
经过上述步骤即可将优化问题P1转化为非线性规划问题，并进而可以通过基于梯度的非线性规划求解器来计算。
由于上述步骤将连续时间变量进行插值离散近似，因此我们需要评估离散化后的误差。若不满足误差，则需要继续增加配点数或细分当前时间区间。在第k个时间区间内选取每两个配点的中心位置，即
Figure BDA0002984748250000076
则在第k个网格区间内的误差可以由飞机运动方程约束满足程度来决定，
Figure BDA0002984748250000077
式中，1≤l≤Mk-1。设置全局最大容许误差值为Emax和最大曲率偏差值C*，hp自适应网格更新策略如下。
(1)计算当前网格区间内运动方程约束的最大误差
Figure BDA0002984748250000081
判断
Figure BDA0002984748250000082
是否小于Emax。若小于则代表第K个网格区间满足误差要求，令k＝k+1，继续计算下一个网格区间的最大误差，直到k＝K；若
Figure BDA0002984748250000083
进行第2步。
(2)计算第k个网格区间内状态变量轨迹曲线的最大曲率比，其定义为
Figure BDA0002984748250000084
式中，
Figure BDA0002984748250000085
为状态轨迹的最大曲率，
Figure BDA0002984748250000088
为状态轨迹的平均曲率。若ck≤C*则进行第3步，继续将区间细分为若干个子区间；否则进行第4步，增大配点个数。
(3)增大网格区间内的配点个数Mk，新的配点个数为
Figure BDA0002984748250000086
其中，ceil(x)函数为向x增大的方向取整。令k＝k+1，返回第1步。
(4)继续细分网格区间，其子区间个数hk为
Figure BDA0002984748250000087
令k＝k+1，返回第1步。
考虑五架无人机由初始的一字型编队重组为V字型编队，最大通信距离为200m，安全防碰撞距离为10m。根据文献[19]，本技术与hp自适应方法计算复杂度分别为O(NpN)2、O(NpN+N2Np)2，N为无人机个数，Np为hp自适应伪谱法各区间总配点数可见本技术在计算复杂度上较低。为了验证本技术的计算效率上的提高，表格1为考虑的五种不同的编队重组初始情况，本技术与hp自适应伪谱法的优化结果、优化求解耗费CPU时间对比见表格2。可见在牺牲极小的最优性的基础上，求解效率大大提高。
表格1无人机群编队重组不同情况
无人机编号 初始坐标(m) 终端相对坐标(m)
UAV1 (-10,30,40) (-15,15,0)
情况1 UAV2 (20,30,55) (-15,-15,0)
UAV3 (50,50,65.5) (0,0,0)
UAV1 (0,10,40) (-12,12,0)
情况2 UAV2 (20,50,50) (-12,-12,0)
UAV3 (40,30,60) (0,0,0)
UAV1 (30,-20,50) (-30,30,0)
UAV2 (30,0,50) (-15,15,0)
情况3 UAV3 (30,20,50) (0,0,0)
UAV4 (30,40,50) (-15,-15,0)
UAV5 (30,60,50) (-30,-30,0)
UAV1 (10,-30,80) (-30,-30,0)
UAV2 (10,0,80) (-15,-15,0)
情况4 UAV3 (10,30,80) (0,0,0)
UAV4 (10,60,80) (-15,15,0)
UAV5 (10,90,80) (-30,30,0)
表格2求解时间与最优值(括号内)对比
Figure BDA0002984748250000091
参考文献：
[1]P.A.Sperandio Giacomin and E.M.Hemerly,“Reconfiguration betweenlongitudinal and circular formations for multi-UAV systems by usingsegments,”Journal of Intelligent and Robotic Systems,vol.78,no.2,pp.339–355,2015.
[2]M.Mahfouz,A.Hafez,M.Ashry,and G.Elnashar,“Formation configurationfor cooperative multiple UAV via backstepping PID controller,”in AIAA SPACEand Astronautics Forum and Exposition,2018.
[3]A.Hafez and S.Givigi,“Formation reconfiguration of cooperativeUAVs via learning basedmodel predictive control in an obstacle-loadedenvironment,”in 2016 Annual IEEE SystemsConference(SYSCON),2016,pp.601–608.
[4]S.Zhou,Y.Kang,H.Dai,and Z.Chao,“Multi-UAVs formation autonomouscontrol method basedon RQPSOFSM-DMPC,”Mathe-matical Problems in Engineering,2016.
[5]A.Grancharova,“UAVs trajectory planning by distributed MPC underradio communication pathloss constraints,”Journal of Intelligent andRoboticSystems,vol.79,no.1,pp.115–134,2015.
[6]D.Liu,H.Liu,Z.Li,X.Hou,and Q.Wang,“Robust attitude control fortail-sitter unmannedaerial vehicles in flight mode transitions,”InternationalJournal of Robust and NonlinearControl,vol.29,no.4,pp.1132–1149,2019.
[7]F.Liao,R.Teo,J.L.Wang,X.Dong,F.Lin,and K.Peng,“Distributedformation andreconfiguration control of VTOL UAVs,”IEEE Trans-actions onControl Systems Technology,vol.25,no.1,pp.270–277,2017.
[8]J.Ghommam,H.Mehrjerdi,and M.Saad,“Robust formation control withoutvelocitymeasurement of the leader robot,”Control Engineering Practice,vol.21,no.8,pp.1143–1156,2013.
[9]D.Wang,Q.Zong,B.Tian,H.Lu,and J.Wang,“Adaptive finite-timereconfiguration controlof unmanned aerial vehicles with a moving leader,”Nonlinear Dynamics,vol.95,no.2,pp.1099–1116,2019.
[10]F.A.Pradipta Lie and T.H.Go,“Reconfiguration control withcollision avoidanceframework for unmanned aerial vehicles in three-dimensional space,”Journal of AerospaceEngineering,vol.26,no.3,pp.637–645,2013.
[11]Z.Jin,T.Shima,and C.J.Schumacher,“Optimal scheduling forrefueling multipleautonomous aerial vehicles,”IEEE Transactions onRobotics,vol.22,no.4,pp.682–693,2006.[12]C.Colombo,M.Vasile,and G.Radice,“Optimal low-thrust trajectories to asteroids throughan algorithm based on differentialdynamic programming,”Celestial Mechanics and DynamicalAstronomy,vol.105,no.1-3,
[13]H.Duan,G.Ma,and D.Luo,“Optimal formation reconfiguration controlof multiple UCAVsusing improved particle swarm optimization,”Journal ofBionic Engineering,vol.5,no.4,pp.340–347,2008.
[14]H.Duan,Q.Luo,G.Ma,and Y.Shi,“Hybrid particle swarm optimizationand genetic algorithm for multi-UAV formation reconfiguration,”IEEEComputational Intelligence Magazine,vol.8,no.3,pp.16–27,2013.
[15]张博渊,宗群,鲁瀚辰,邵士凯.基于hp自适应伪谱法的四旋翼无人机编队轨迹优化[J].中国科学:技术科学,2017,47(03):239-248.
[16]R.Chai,A.L.Savvaris,and A.Tsourdos,“Violation learningdifferential evolution-based hp-adaptive pseudospectral method for trajectoryoptimization of space maneuver vehicle,”IEEE Transactions on Aerospace andElectronic Systems,vol.53,no.4,pp.2031–2044,AUG 2017.[17]邵士凯,彭瑜,贾慧敏,杜云.基于改进高斯伪谱法的多无人机协同轨迹规划[J].河北科技大学学报,2020,41(02):122-132.
[18]C.L.Darby,W.W.Hager,A.V.Rao,Direct trajectory optimization usinga variable low-order adaptive pseudospectral method,Journal of Spacecraft andRockets，vol.48,no.3,pp.433–445,2011.
C.Schmid,L.Biegler,Quadratic-programming methods for reduced HessianSQP,Computes and Chemical Engineering，vol.18,no.9,pp.817–832,1994.
本发明的技术方案不限于上述具体实施例的限制，凡是根据本发明的技术方案做出的技术变形，均落入本发明的保护范围之内。

Claims (1)

1.一种多无人机编队重组轨迹规划方法，其特征在于，包括以下步骤：
S1：建立包含动力学方程、通信距离约束条件、机动性能约束条件、安全距离约束、终端队形约束的多固定翼无人机编队重组问题的非线性最优控制模型；考虑三自由度固定翼无人机制导系统动态方程，
Figure FDA0003389391260000011
Figure FDA0003389391260000012
Figure FDA0003389391260000013
Figure FDA0003389391260000014
Figure FDA0003389391260000015
Figure FDA0003389391260000016
其中i＝1,2,...,N为无人机编号，γ为爬升角，χ为偏航角，μ为滚转角，T为推力，D为阻力，n代表的是无人机的负载系数，之后考虑无人机及及无人机间的通信距离约束条件、机动性能约束条件、安全距离约束、终端队形约束，通信距离及安全距离机间约束：
Dsafe≤di,j(t)≤Dcomm,
Figure FDA0003389391260000017
di,j(t)为任意两架无人机间的距离；
机动性能约束：
vmin≤vi≤vmax
χmin≤χi≤χmax
γmin≤γi≤γmax
Tmin≤Ti≤Tmax
Figure FDA0003389391260000018
nmin≤ni≤nmax
设第N架无人机为队形中心，则终端队形约束为：
Figure FDA0003389391260000019
考虑时间最有编队重组，目标函数可以表达为，
Figure FDA0003389391260000021
至此，多固定翼无人机编队重组问题的非线性最优控制问题可以表示为如下问题P0，
Figure FDA0003389391260000022
s.t.
Figure FDA0003389391260000023
vmin≤vi≤vmax
γmin≤γi≤γmax
Tmin≤Ti≤Tmax
Figure FDA0003389391260000024
nmin≤ni≤nmax,i＝1,2,…,N
hi＝0,i＝1,2,…,N-1
Dsafe≤di,j(t)≤Dcomm
Figure FDA0003389391260000025
S2：应用精准罚函数方法，针对非线性状态等式及不等式约束，将P0问题进一步处理为问题P1；目标函数变为
Figure FDA0003389391260000026
问题P1可以描述如下：
Figure FDA0003389391260000027
s.t.
Figure FDA0003389391260000028
vmin≤vi≤vmax
γmin≤γi≤γmax
Tmin≤Ti≤Tmax
Figure FDA0003389391260000029
nmin≤ni≤nmax,i＝1,2,…,N
S3：应用hp自适应伪谱法将问题P1转化为非线性规划问题进行求解，包括以下步骤：
1)时间区间转换：设飞机爬升时间为t∈[t0,tf]，将其分为K份网格区间[tk-1,tk)，k＝1,2,…,K，其中tK＝tf；在每个网格区间t∈[tk-1,tk)内，时间范围可由下式转化为τ∈[-1,1)，
Figure FDA0003389391260000031
2)选择LGR配点：在每个网格区间内选择Mk个LGR配点，通过求解下列Mk阶勒让德方程即可得到配点，
Figure FDA0003389391260000032
其中
Figure FDA0003389391260000033
3)状态和控制变量离散化：连续时间状态和控制变量由拉格朗日多项式进行插值近似离散化，由于Radau伪谱法中的LGR配点不包括端点，为了保持状态变量在整个时间区间上的连续性以及终端状态值的优化，在每段时间区间上，增加τ＝1的配点，状态量与控制量可以近似为
Figure FDA0003389391260000034
Figure FDA0003389391260000035
其中，Li(τ)为拉格朗日多项式基式；
4)动态方程转换：由上式，状态变量对τ的导数为
Figure FDA0003389391260000036
进而，状态方程可转化为下列代数约束
Figure FDA0003389391260000037
式中，
Figure FDA0003389391260000038
为在第k个时间区间的Radau伪谱微分矩阵；
5)目标函数以及约束近似化：考虑如下Bolza形式的目标函数
Figure FDA0003389391260000041
通过Radau伪谱法，目标函数可以近似为
Figure FDA0003389391260000042
式中
Figure FDA0003389391260000043
为积分权重系数；
将优化问题P1的不等式约束以及等式约束表示为
Figure FDA0003389391260000044
代入近似后的状态以及控制量后，约束可以近似为
Figure FDA0003389391260000045
式中，i＝1,2,…,Mk,k＝1,2,…,K；
经过上述步骤即可将优化问题P1转化为非线性规划问题，并进而能够通过基于梯度的非线性规划求解器来计算；
求解步骤后需要评估离散化后的误差，若不满足误差，则需要继续增加配点数或细分当前时间区间，在第k个时间区间内选取每两个配点的中心位置，即
Figure FDA0003389391260000046
则在第k个网格区间内的误差可以由飞机运动方程约束满足程度来决定，
Figure FDA0003389391260000047
式中，1≤l≤Mk-1；设置全局最大容许误差值为Emax和最大曲率偏差值C*，hp自适应网格更新策略如下：
(1)计算当前网格区间内运动方程约束的最大误差
Figure FDA0003389391260000048
判断
Figure FDA0003389391260000051
是否小于Emax；若小于则代表第K个网格区间满足误差要求，令k＝k+1，继续计算下一个网格区间的最大误差，直到k＝K；若
Figure FDA0003389391260000052
进行第(2)步；
(2)计算第k个网格区间内状态变量轨迹曲线的最大曲率比，其定义为
Figure FDA0003389391260000053
式中，
Figure FDA0003389391260000054
为状态轨迹的最大曲率，
Figure FDA0003389391260000055
为状态轨迹的平均曲率；若ck≤C*则进行第3步，继续将区间细分为若干个子区间；否则进行第4步，增大配点个数；
(3)增大网格区间内的配点个数Mk，新的配点个数为
Figure FDA0003389391260000056
其中，ceil(x)函数为向x增大的方向取整；令k＝k+1，返回第(1)步；
(4)继续细分网格区间，其子区间个数hk为
Figure FDA0003389391260000057
令k＝k+1，返回第(1)步。
CN202110297086.9A 2021-03-19 2021-03-19 一种多无人机编队重组轨迹规划方法 Active CN113050687B (zh)

Priority Applications (1)

Application Number Priority Date Filing Date Title
CN202110297086.9A CN113050687B (zh) 2021-03-19 2021-03-19 一种多无人机编队重组轨迹规划方法

Applications Claiming Priority (1)

Application Number Priority Date Filing Date Title
CN202110297086.9A CN113050687B (zh) 2021-03-19 2021-03-19 一种多无人机编队重组轨迹规划方法

Publications (2)

Publication Number Publication Date
CN113050687A CN113050687A (zh) 2021-06-29
CN113050687B true CN113050687B (zh) 2022-02-01

Family

ID=76513880

Family Applications (1)

Application Number Title Priority Date Filing Date
CN202110297086.9A Active CN113050687B (zh) 2021-03-19 2021-03-19 一种多无人机编队重组轨迹规划方法

Country Status (1)

Country Link
CN (1) CN113050687B (zh)

Families Citing this family (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN113650622B (zh) * 2021-07-16 2023-06-20 东风柳州汽车有限公司 车速轨迹规划方法、装置、设备及存储介质
CN114740733B (zh) * 2022-04-24 2022-11-22 四川大学 一种航天器姿态重定向的最优固定时间滑模控制方法
CN116679751A (zh) * 2023-06-08 2023-09-01 四川大学 考虑飞行约束的多飞行器协同搜索方法
CN116679738B (zh) * 2023-06-13 2024-01-19 四川大学 一种基于精确罚函数的航天器时间最优姿态控制方法

Family Cites Families (4)

* Cited by examiner, † Cited by third party
Publication number Priority date Publication date Assignee Title
CN110913402A (zh) * 2019-11-27 2020-03-24 南京航空航天大学 一种联合优化通信与编队的高覆盖效率的无人机自组网分簇方法
CN110989626B (zh) * 2019-12-27 2021-07-27 四川大学 一种基于控制参数化的无人机路径规划方法
CN111562797B (zh) * 2020-07-06 2021-07-30 北京理工大学 确保收敛的无人机飞行时间最优实时轨迹优化方法
CN112148024B (zh) * 2020-08-20 2022-04-08 中国人民解放军海军航空大学 基于自适应伪谱法的无人机实时在线航迹规划方法

Also Published As

Publication number Publication date
CN113050687A (zh) 2021-06-29

Similar Documents

Publication Publication Date Title
CN113050687B (zh) 一种多无人机编队重组轨迹规划方法
Zhang et al. Multi-UAV formation control based on a novel back-stepping approach
CN111562797B (zh) 确保收敛的无人机飞行时间最优实时轨迹优化方法
Kada et al. Robust PID controller design for an UAV flight control system
Duan et al. ? Hybrid particle swarm optimization and genetic algorithm for multi-UAV formation reconfiguration
Dutta et al. A decentralized formation and network connectivity tracking controller for multiple unmanned systems
Babazadeh et al. Distance-based multiagent formation control with energy constraints using SDRE
Eslamiat et al. Autonomous waypoint planning, optimal trajectory generation and nonlinear tracking control for multi-rotor uavs
Jiang et al. Integrated guidance for Mars entry and powered descent using reinforcement learning and pseudospectral method
Zhang et al. A globally fixed-time solution of distributed formation control for multiple hypersonic gliding vehicles
Hafez et al. Unmanned aerial vehicles formation using learning based model predictive control
Ali et al. A Leader‐Follower Formation Control of Multi‐UAVs via an Adaptive Hybrid Controller
Babazadeh et al. Anoptimal displacement-based leader-follower formation control for multi-agent systems with energy consumption constraints
Wang et al. Multiple quadrotors formation flying control design and experimental verification
CN116027809A (zh) 一种DoS攻击下的多四旋翼无人机编队控制方法
Lan et al. ADP-based intelligent decentralized control for multi-agent systems moving in obstacle environment
Lv et al. Fast nonsingular fixed-time fuzzy fault-tolerant control for HFVs with guaranteed time-varying flight state constraints
Lazim et al. Intelligent observer-based feedback linearization for autonomous quadrotor control
Ma et al. A joint guidance and control framework for autonomous obstacle avoidance in quadrotor formations under model uncertainty
Zhang et al. Trajectory optimization and finite-time control for unmanned helicopters formation
Chen et al. Decentralized H PID Team Formation Tracking Control of Large-Scale Quadrotor UAVs Under External Disturbance and Vortex Coupling
Rui Multi-UAV formation maneuvering control based on Q-learning fuzzy controller
Xi et al. MPC based motion control of car-like vehicle swarms
Liu et al. A learning-based fuzzy lqr control scheme for height control of an unmanned quadrotor helicopter
Xu et al. Optimal control of UAV elastic formation based on legendre pseudospectral method

Legal Events

Date Code Title Description
PB01 Publication
PB01 Publication
SE01 Entry into force of request for substantive examination
SE01 Entry into force of request for substantive examination
GR01 Patent grant
GR01 Patent grant