CN111046486A - 运载火箭一子级伞控回收航迹规划方法 - Google Patents
运载火箭一子级伞控回收航迹规划方法 Download PDFInfo
- Publication number
- CN111046486A CN111046486A CN201911126635.5A CN201911126635A CN111046486A CN 111046486 A CN111046486 A CN 111046486A CN 201911126635 A CN201911126635 A CN 201911126635A CN 111046486 A CN111046486 A CN 111046486A
- Authority
- CN
- China
- Prior art keywords
- artificial fish
- sub
- level
- stage
- parafoil
- 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.)
- Granted
Links
- 238000011084 recovery Methods 0.000 title claims abstract description 56
- 238000000034 method Methods 0.000 title claims abstract description 44
- 241000251468 Actinopterygii Species 0.000 claims abstract description 135
- IBSREHMXUMOFBB-JFUDTMANSA-N 5u8924t11h Chemical compound O1[C@@H](C)[C@H](O)[C@@H](OC)C[C@@H]1O[C@@H]1[C@@H](OC)C[C@H](O[C@@H]2C(=C/C[C@@H]3C[C@@H](C[C@@]4(O3)C=C[C@H](C)[C@@H](C(C)C)O4)OC(=O)[C@@H]3C=C(C)[C@@H](O)[C@H]4OC\C([C@@]34O)=C/C=C/[C@@H]2C)/C)O[C@H]1C.C1=C[C@H](C)[C@@H]([C@@H](C)CC)O[C@]11O[C@H](C\C=C(C)\[C@@H](O[C@@H]2O[C@@H](C)[C@H](O[C@@H]3O[C@@H](C)[C@H](O)[C@@H](OC)C3)[C@@H](OC)C2)[C@@H](C)\C=C\C=C/2[C@]3([C@H](C(=O)O4)C=C(C)[C@@H](O)[C@H]3OC\2)O)C[C@H]4C1 IBSREHMXUMOFBB-JFUDTMANSA-N 0.000 claims abstract description 55
- 238000005457 optimization Methods 0.000 claims abstract description 21
- 238000005520 cutting process Methods 0.000 claims abstract description 20
- 230000008569 process Effects 0.000 claims abstract description 20
- 230000006399 behavior Effects 0.000 claims abstract description 14
- 239000002245 particle Substances 0.000 claims abstract description 14
- 241000287127 Passeridae Species 0.000 claims abstract description 12
- 230000002431 foraging effect Effects 0.000 claims abstract description 10
- 238000013459 approach Methods 0.000 claims abstract description 7
- 235000013305 food Nutrition 0.000 claims description 25
- 230000033001 locomotion Effects 0.000 claims description 16
- 230000000007 visual effect Effects 0.000 claims description 15
- 238000013461 design Methods 0.000 claims description 13
- 230000007704 transition Effects 0.000 claims description 13
- 238000004088 simulation Methods 0.000 claims description 7
- 238000006073 displacement reaction Methods 0.000 claims description 6
- 230000005484 gravity Effects 0.000 claims description 6
- 230000019637 foraging behavior Effects 0.000 claims description 3
- 238000013178 mathematical model Methods 0.000 claims description 3
- 238000005096 rolling process Methods 0.000 claims description 3
- 238000004422 calculation algorithm Methods 0.000 abstract description 9
- 230000002776 aggregation Effects 0.000 abstract description 4
- 238000004220 aggregation Methods 0.000 abstract description 4
- 230000006870 function Effects 0.000 description 23
- 238000010586 diagram Methods 0.000 description 4
- 230000009471 action Effects 0.000 description 3
- 238000005265 energy consumption Methods 0.000 description 2
- 238000000926 separation method Methods 0.000 description 2
- 238000009827 uniform distribution Methods 0.000 description 2
- 241000764238 Isis Species 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000004364 calculation method Methods 0.000 description 1
- 239000012050 conventional carrier Substances 0.000 description 1
- 230000003247 decreasing effect Effects 0.000 description 1
- 230000007547 defect Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000018109 developmental process Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 230000006872 improvement Effects 0.000 description 1
- 238000012804 iterative process Methods 0.000 description 1
- 230000011218 segmentation Effects 0.000 description 1
- ANRHNWWPFJCPAZ-UHFFFAOYSA-M thionine Chemical compound [Cl-].C1=CC(N)=CC2=[S+]C3=CC(N)=CC=C3N=C21 ANRHNWWPFJCPAZ-UHFFFAOYSA-M 0.000 description 1
Images
Classifications
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64D—EQUIPMENT FOR FITTING IN OR TO AIRCRAFT; FLIGHT SUITS; PARACHUTES; ARRANGEMENT OR MOUNTING OF POWER PLANTS OR PROPULSION TRANSMISSIONS IN AIRCRAFT
- B64D17/00—Parachutes
- B64D17/62—Deployment
- B64D17/64—Deployment by extractor parachute
-
- B—PERFORMING OPERATIONS; TRANSPORTING
- B64—AIRCRAFT; AVIATION; COSMONAUTICS
- B64G—COSMONAUTICS; VEHICLES OR EQUIPMENT THEREFOR
- B64G1/00—Cosmonautic vehicles
- B64G1/22—Parts of, or equipment specially adapted for fitting in or to, cosmonautic vehicles
- B64G1/62—Systems for re-entry into the earth's atmosphere; Retarding or landing devices
Landscapes
- Engineering & Computer Science (AREA)
- Aviation & Aerospace Engineering (AREA)
- Remote Sensing (AREA)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Management, Administration, Business Operations System, And Electronic Commerce (AREA)
Abstract
本发明公开了一种运载火箭一子级伞控回收航迹规划方法，用于解决现有运载火箭一子级回收方法实用性差的技术问题。技术方案是在一子级‑翼伞系统六自由度模型的基础上，建立系统航迹规划简化质点模型，将一子级归航航迹划分为径向飞行段、盘旋削高段、逆风接近段和雀降段四个阶段，建立对应航迹的几何关系；然后，在分段归航的基础上，建立一子级归航航迹多目标函数约束条件，满足一子级落点精度之后对归航过程系统能量损耗进行约束；将人工鱼群算法引入一子级回收航迹规划当中，通过觅食、聚群、追尾行为加快航迹规划过程参数寻优的收敛速度和稳定性，提高最优参数的求解精度，使一子级精准回收的同时能量损耗达到最少，实用性好。
Description
技术领域
本发明涉及一种运载火箭一子级回收方法，特别涉及一种运载火箭一子级伞控回收航迹规划方法。
背景技术
我国航天事业的发展已经取得了非常显著的成绩，航天发射活动、发射频次位居世界前列。然而，由于技术的限制，我国各型火箭发射中一子级分离体仍然无法实现 坠入指定区域，其着陆偏差达十几公里，甚至上百公里，分离体落点失控带来的人身、 财产损失问题引发了社会上的广泛关注。近年来兴起的冲压式翼伞因其具有优良的滑 翔性能、稳定性和可操纵性，在航天器回收、空投领域得到了广泛的应用。通过翼伞 系统来回收火箭一子级，相当于给一子级配置了“柔性机翼”，利用翼伞系统的可控性 和高滑翔特性使一子级精准、安全降落在指定区域内。
我国学者熊菁采用分段归航策略对翼伞系统轨迹进行规划[熊菁.翼伞系统分段归 航轨迹的优化设计[J].航天返回与遥感,2004(03):11-16.]，根据翼伞飞行轨迹在水平面上 的投影为直线和圆的组合，将系统轨迹划分为径向飞行段、盘旋削高段、逆风接近段和雀降阶段，利用各段轨迹的几何关系，将轨迹优化问题转化为参数寻优问题求解， 实现了空投物投放过程中的航迹设计。
分段归航设计的方法以其轨迹可知和操纵简单的特点而备受关注，但分段归航方法是根据先前试验经验选择恒定盘旋半径和偏转角度来设计一子级回收航迹，仅保证 了一子级的落点精度，归航过程中翼伞系统能量损耗过多的问题并没有很好的解决， 需要进一步的完善，以使一子级精准回收的同时减少系统能量损耗。
发明内容
为了克服现有运载火箭一子级回收方法实用性差的不足，本发明提供一种运载火箭一子级伞控回收航迹规划方法。该方法在一子级-翼伞系统六自由度模型的基础上， 建立系统航迹规划简化质点模型，将一子级归航航迹划分为径向飞行段、盘旋削高段、 逆风接近段和雀降段四个阶段，建立对应航迹的几何关系；然后，在分段归航的基础 上，建立一子级归航航迹多目标函数约束条件，满足一子级落点精度之后对归航过程 系统能量损耗进行约束；将人工鱼群算法引入一子级回收航迹规划当中，通过觅食、 聚群、追尾行为加快航迹规划过程参数寻优的收敛速度和稳定性，提高最优参数的求 解精度，使一子级精准回收的同时能量损耗达到最少，实用性好。
本发明解决其技术问题所采用的技术方案：一种运载火箭一子级伞控回收航迹规划方法，其特点是包括以下步骤：
步骤一、建立一子级-翼伞系统归航过程六自由度数学模型，系统的十二个微分方程如下：
一子级-翼伞系统动力学方程：
一子级-翼伞系统角运动方程如下：
一子级-翼伞系统的姿态角与角速度之间关系如下：
一子级-翼伞系统质心在地面坐标系中的位置关系如下：
其中，一子级-翼伞系统总质量m＝mw+mc+mf，mw,mc,mf分别为火箭一子级 质量、翼伞质量和系统附加质量；x,y,z分别是一子级-翼伞系统的位移；u,v,w分别 表示一子级-翼伞速度在体坐标系内沿x轴、y轴、z轴的速度分量；pc、qc、rc分别 是一子级-翼伞绕x轴、y轴和z轴的角速度分量；φc、θc、ψc分别是一子级-翼伞的滚 转角、俯仰角、偏航角；(Ixx、Iyy、Izz)，(L、M、N)，(Mx、My、Mz)分别为系统在各轴 上的转动惯量、气动力矩和重力力矩。
在翼伞系统控制下，火箭一子级做稳定滑翔运动，在受到重力和气动力的平衡作用后，系统水平飞行速度vl和垂直下降速度vz保持不变，此时，将一子级-翼伞系统六 自由度模型简化为质点模型。取坐标系为大地坐标系，坐标原点为航迹规划的目标点， 得到的系统质点模型为，
式中，ψ，
分别为一子级-翼伞系统飞行过程中的转弯角度、转弯角速度，u表 示系统控制量。
步骤二、结合一子级-翼伞系统模型仿真获取的系统飞行特性，对一子级回收航迹进行划分，将归航航迹划分为径向飞行段、盘旋削高段、逆风着陆段和雀降段四个过 程。
步骤三、建立一子级回收过程各段航迹的位置和长度的几何关系。在径向飞行阶段，过渡圆弧圆心坐标O1为：
径向飞行段的位移即为
之间的距离为：
径向飞行阶段
与X轴正向夹角为：
圆弧O1对应的圆心角β1：
在盘旋削高阶段，过渡圆弧对应的圆心O2坐标为：
过渡圆弧O2对应的圆心角β2为：
圆弧O3对应的圆心角β3为：
β3＝-α3-s×θET，若β3＜0，β3＝β3+2π (13)
在逆风接近阶段，过渡圆弧O4的夹角β4为：
其中，Rmin表示一子级回收航迹中AB段、CD段、EF段的转弯半径；β1，β2，β4分别表示一子级返回航迹中转弯段对应的圆弧段弧度；RET表示盘旋阶段DE的盘旋 半径；β3表示盘旋阶段对应的圆弧段弧度；θET表示盘旋削高阶段的方位角； 
α0表示初始位置对应的方位角。
步骤四、一子级回收航迹规划的关键是盘旋削高阶段的进入点(RET,θET)的确定。根据一子级-翼伞系统的质点模型，以及评价航迹的标准，建立目标函数为：
式中，Rmin表示一子级回收航迹中过渡圆弧段的转弯半径；RET表示盘旋阶段的 盘旋半径，||BC||表示一子级返回中滑翔段在水平面内投影的距离；β1，β2，β3，β4表 示一子级归航航迹中转弯段对应的圆弧段弧度；k为一子级-翼伞系统稳定飞行时的滑 翔比，z0为翼伞系统开始工作时一子级的高度。
F1表示一子级着陆时的偏差，即设计的一子级航迹的水平飞行距离与定滑翔比条件下初始高度对应的水平飞行距离(k·z0)的差值的绝对值；F2表示一子级回收过程 消耗的能量，u表示翼伞系统的控制量，大小与系统的转弯半径有关。
F＝min{k1|Y1|+k2|Y2|} (17)
F表示F1、F2的加权求和，k1、k2为比例系数,将F1、F2优化至相同量纲。
设定航迹规划约束条件为：盘旋阶段的盘旋半径RET∈[R1,R2]，R1,R2为一子级- 翼伞模型的转弯半径的上、下限；盘旋削高阶段进入点C长度||OC||∈[R1,R2]，方位角 θET∈[-π,π]。
步骤五、设置人工鱼群参数，人工鱼个体的状态表示为向量X＝(x1,x2,…,xn)， 其中xi(i＝1,…,n)即寻优的变量；人工鱼当前位置的食物浓度表示为Y＝f(X)，其中， Y为目标函数值。设置人工鱼的规模N、状态维数n、边界范围[bmin,bmax]；人工鱼的 视野范围Visual、人工鱼移动的最大步长Step、人工鱼拥挤度因子δ，人工鱼搜索食 物浓度的尝试次数try-number和最大迭代次数lmax。
步骤六、引入Rand()随机函数产生n行，N＝列的0～1之间的随机数，初始化鱼 群，生成N条人工鱼。
xki＝bmin k+Rand()×(bmaxk-bmink) (18)
其中，bmin，bmax为寻优参数的取值下限、上限，k＝1,2…n；Rand()为生成一个0～ 1之间均匀分布的随机函数。
步骤七、公告牌初始化，计算出当前状态下鱼群中各条人工鱼的食物浓度 Y＝(y1,y2,…,yn)，逐个比较目标值，将最优的人工鱼状态放入公告牌中。
步骤八、执行单次迭代寻优，当前状态人工鱼i。
步骤九、对每条人工鱼进行评价，对其要执行的行为进行选择。在人工鱼随机行为中，第i条人工鱼Xi视野范围内的觅食状态为：
在人工鱼觅食行为中，第i条人工鱼Xi视野范围内，产生觅食状态Xj，比较Xi、 Xj的目标函数Yi、Yj的大小，选择下一步移动状态，
在人工鱼聚群行为中，计算第i条人工鱼Xi与第j条人工鱼之间的距离dij以及与鱼群中所有人工鱼之间的距离Di，其中，dij＝||Xi-Xj||(1≤i≤N,1≤j≤N)， Di＝(di1,di2,…,din)；搜索该人工鱼Xi当前视野内的伙伴数目nf，并计算周围伙伴的 当前状态(Xi1,Xi2,…,Xin)，以及中心位置Xc，其中，
然 后判断中心状态Xc的食物浓度Yc与第i条人工鱼Xi的食物浓度Yi的关系，若满足 Yc/nf>δ×Yi，Xi朝伙伴的中心位置移动一步
在人工鱼追尾行为中，计算Xi当前视野内其他人工鱼的数目nf以及对应的食物 浓度(Yi1,Yi2,…,Yin)，找到食物浓度最大的人工鱼Xj；搜索人工鱼Xj当前视野内的其 他人工鱼数目m；若人工鱼Xj的食物浓度Yj大于人工鱼Xi的食物浓度Yi，即满足 Yj/m＞δ×Yi，则Xi朝最优人工鱼Xj位置移动一步
步骤十、每条人工鱼执行一次后，检验自身状态，若食物浓度优于公告牌，则将 该人工鱼的食物浓度和当前状态更新到公告牌。
步骤十一、依次执行所有的人工鱼，直到达到最大迭代次数，输出公告牌上的人工鱼状态Xbest及对应食物浓度Ybest，即一子级回收航迹设计中盘旋阶段的最优进入点 坐标。
步骤十二、将计算的最优航迹参数带入一子级回收规划的航迹中，计算径向飞行阶段、盘高阶段、逆风着陆阶段以及雀降阶段的航迹设计参数。
步骤十三、将一子级各阶段航迹设计参数带入一子级-翼伞六自由度模型中，仿真调试，显示一子级回收航迹规划结果。
本发明的有益效果是：该方法在一子级-翼伞系统六自由度模型的基础上，建立系统航迹规划简化质点模型，将一子级归航航迹划分为径向飞行段、盘旋削高段、逆风 接近段和雀降段四个阶段，建立对应航迹的几何关系；然后，在分段归航的基础上， 建立一子级归航航迹多目标函数约束条件，满足一子级落点精度之后对归航过程系统 能量损耗进行约束；将人工鱼群算法引入一子级回收航迹规划当中，通过觅食、聚群、 追尾行为加快航迹规划过程参数寻优的收敛速度和稳定性，提高最优参数的求解精度， 使一子级精准回收的同时能量损耗达到最少，实用性好。
具体的，1)在一子级-翼伞系统六自由模型的基础上，根据一子级回收过程运动特性，建立简化的系统航迹规划质点模型，计算简单，在工程上易于实现；
2)在分段归航方法设计航迹的基础上，建立多目标函数约束条件，保证一子级落点精度之后对归航过程系统的能量损耗进行约束；
3)将人工鱼群算法引入一子级回收航迹规划当中，通过觅食、聚群、追尾行为加快一子级回收航迹规划中参数寻优的收敛速度和收敛稳定性，提高最优参数的求解精 度，使一子级精准回收的同时，能量损耗达到最少。
下面结合附图和具体实施方式对本发明作详细说明。
附图说明
图1是本发明运载火箭一子级伞控回收航迹规划方法的流程图。
图2是图1中分段归航划分一子级航迹的示意图。
图3是图1中人工鱼群算法寻找最优航迹参数算法的流程图。
图4是本发明方法实施例中一子级回收航迹优化目标函数收敛迭代过程图。
图5是本发明方法实施例中一子级回收过程的能量控制输出对比图。
图6是本发明方法实施例中一子级回收航迹规划三维轨迹仿真对比图。
图7是本发明方法实施例中一子级回收航迹规划平面轨迹仿真对比图。
具体实施方式
参照图1-7。本实施例中硬件环境为：GPU：Intel至强系列，内存：8G，硬盘： 500G机械硬盘；软件采用MATLAB2016a进行仿真实验。
本发明运载火箭一子级伞控回收航迹规划方法具体步骤如下：
步骤1、为实时得到火箭一子级返回过程的速度和位置信息，在MATLAB/Simulink软件中搭建一子级-翼伞系统的六自由度数学模型，用于描述系统质心三个方向的线运 动以及角运动，建立的一子级-翼伞系统12个微分方程如下：
一子级-翼伞系统动力学方程：
一子级-翼伞系统角运动方程如下：
一子级-翼伞系统的姿态角与角速度之间关系如下：
一子级-翼伞系统质心在地面坐标系中的位置关系如下：
其中，一子级-翼伞系统总质量m＝mw+mc+mf，mw,mc,mf分别为火箭一子级 质量、翼伞质量和系统附加质量；x,y,z分别是一子级-翼伞系统的位移；u,v,w分别 表示一子级-翼伞速度在体坐标系内沿x轴、y轴、z轴的速度分量；pc、qc、rc分别 是一子级-翼伞绕x轴、y轴和z轴的角速度分量；φc、θc、ψc分别是一子级-翼伞的滚 转角、俯仰角、偏航角；(Ixx、Iyy、Izz)，(L、M、N)，(Mx、My、Mz)分别为系统在各轴 上的转动惯量、气动力矩和重力力矩。
在翼伞系统控制下，一子级做稳定滑翔运动，此时一子级-翼伞系统为一个质点，在受到重力和气动力的平衡作用后，系统水平飞行速度vl和垂直下降速度vz保持不变。 基于以上假设，将一子级-翼伞系统六自由度模型简化为质点模型，便于航迹规划。取 坐标系为大地坐标系，坐标原点为航迹规划的目标点，得到的系统质点模型为，
式中，ψ，
分别为一子级-翼伞系统飞行过程中的转弯角度、转弯角速度，u表 示系统控制量。
设定某型火箭一子级回收航迹规划初始条件：一子级-翼伞系统总质量为2000kg,翼伞完全展开时，系统的初始位置为(0，0，8000)，着陆点为(2100,1000,0)，系统 稳定飞行时水平速度17m/s。
步骤2、翼伞系统主要包括滑翔、盘旋下降以及雀降三种基本的运动方式，对于 有明确着陆目标和落地速度要求的一子级来说，雀降实施的高度是一定的。因此在系 统航迹规划过程中只考虑滑翔、盘旋两项运动。翼伞的滑翔运动在水平面的投影是一 条直线，盘旋运动在水平面的投影为圆或圆弧，因此一子级回收的航迹在水平面的投 影是直线或圆弧的组合。结合步骤1系统模型仿真得到的坐标信息，对一子级回收航 迹进行划分，一子级-翼伞系统自A点投放，于AB段调整系统飞行航向；BC段为径 向飞行段，系统以稳定速度飞行预定目标上空；到达C点后，选取合适的转弯半径绕 预定着陆点盘旋，即为盘旋削高段；通过DE段调整系统飞行航向，于E点进入逆风 接近段；当接近预定着陆点时，进入雀降段直至一子级最终着陆。
步骤3、建立一子级回收过程各段航迹的位置和长度的几何关系，
步骤3.1、一子级回收航迹中径向飞行阶段的过渡圆弧圆心坐标O1为
径向飞行段的位移即为
之间的距离为
径向飞行阶段
与X轴正向夹角为
圆弧O1对应的圆心角β1为
步骤3.2、盘旋削高段的过渡圆弧对应的圆心O2为
过渡圆弧O2对应的圆心角β2为
盘旋削高阶段对应的圆弧O3对应的圆心角β3为 β3＝-α3-s×θET，若β3＜0，β3＝β3+2π (13)
步骤3.3、逆风接近阶段的过渡圆弧O4的夹角β4为
其中，Rmin表示一子级回收航迹中AB段、CD段、EF段的转弯半径；β1，β2，β4分别表示一子级返回航迹中转弯段对应的圆弧段弧度；RET表示盘旋阶段DE的盘旋 半径；β3表示盘旋阶段对应的圆弧段弧度；θET表示盘旋削高阶段的方位角； 
α0表示初始位置对应的方位角。
步骤4、建立一子级回收航迹优化的目标函数，设定航迹规划约束条件。
步骤4.1、根据步骤3中一子级回收过程各段路径的几何关系，将航迹优化问题转化为最优解求解问题。一子级回收航迹规划的关键是盘旋削高阶段的进入点(RET,θET) 的确定。对于一子级回收而言，航迹规划的目标是控制能量小，落点精度高，根据一 子级-翼伞系统的质点模型，以及评价航迹的标准，建立目标函数为：
式中，Rmin表示一子级回收航迹中过渡圆弧段的转弯半径；RET表示盘旋阶段的 盘旋半径，||BC||表示一子级返回中滑翔段在水平面内投影的距离；β1，β2，β3，β4表 示一子级归航航迹中转弯段对应的圆弧段弧度；k为一子级-翼伞系统稳定飞行时的滑 翔比，z0为翼伞系统开始工作时一子级的高度。
F1表示一子级着陆时的偏差，即设计的一子级航迹的水平飞行距离与定滑翔比条件下初始高度对应的水平飞行距离(k·z0)的差值的绝对值；F2表示一子级回收过程 消耗的能量，u表示翼伞系统的控制量，大小与系统的转弯半径有关。
F＝min{k1|Y1|+k2|Y2|} (17)
F值是F1、F2的加权求和，由于F1表示距离而F2表示角度，因此加入比例系数 k1、k2,将F1、F2优化至相同量纲。F值越接近于0，表示规划的轨迹越满足要求。
步骤4.2、为实现一子级的精准、稳定回收着陆，航迹规划时，从三个方面进行约束规划：1)根据步骤1中的一子级-翼伞模型仿真获取的系统飞行特性，一子级回收 过程中盘旋半径有一定的范围；2)为了提高一子级-翼伞系统的稳定性以及降低能耗， 盘旋阶段的盘旋半径取较大值；3)盘旋阶段的盘旋半径也不应过大，便于控制一子级 的着陆精度。
因此，设定航迹规划约束条件：盘旋阶段的盘旋半径RET∈[R1,R2]， R1＝45m,R2＝250m为一子级-翼伞模型转弯半径的上、下限，最小转弯半径 Rmin＝45m；盘旋削高阶段进入点C长度||OC||∈[45,250]m，方位角θET∈[-π,π]；目 标函数中k1取1，k2取10；算法迭代结束的条件为目标函数值小于0.02。
步骤5、设置人工鱼群参数，人工鱼个体的状态表示为向量X＝(x1,x2,…,xn)， 其中xi(i＝1,…,n)即寻优的变量；人工鱼当前位置的食物浓度表示为Y＝f(X)，其中Y 为目标函数值。在一子级回收航迹寻优中，人工鱼的位置代表一子级回收过程中不同 的盘旋削高进入点的坐标，人工鱼的状态代表该点的目标函数值，人工鱼向食物浓度 高的地方运动过程即向着目标函数值变小的方向运动。
设置人工鱼群算法初始条件：人工鱼个数N＝50，状态维数n＝2， [bmin1,bmax1]＝[45,250]，[bmin2,bmax2]＝[-π,π]，人工鱼的视野范围Visual＝10、人工鱼 移动的最大步长Step＝0.7、人工鱼拥挤度因子δ＝0.2；人工鱼搜索食物浓度的尝试次 数为try-number＝10、最大迭代次数lmax＝30。
步骤6、鱼群初始化。结合一子级航迹规划寻优目标表达式，鱼群中每条人工鱼 的状态为2维向量，确定鱼群个数N＝50，状态变量维数n＝2，引入Rand()随机函数产 生n＝2行，N＝50列的0～1之间的随机数，结合状态变量取值范围[bmink,bmaxk]，k＝1,2， 初始化鱼群，生成50条人工鱼。
xki＝bmin k+Rand()×(bmaxk-bmink) (18)
其中，bmin，bmax为寻优参数的取值下限、上限，k＝1，2；Rand()为能生成一个0～ 1之间均匀分布的随机函数。
步骤7、公告牌初始化。由步骤5中的目标函数Y＝f(X)，计算出当前状态下鱼 群中各条人工鱼的食物浓度Y＝(y1,y2,…,yn)，逐个比较目标值，将最优的人工鱼状 态放入公告牌中。
步骤8、执行单次迭代寻优：令当前更新状态人工鱼i＝1；
步骤9、对每条人工鱼进行评价，对其要执行的行为进行选择，
步骤9.1、执行人工鱼随机行为：
在第i条人工鱼当前状态Xi视野范围内随机移动一步，到达一个新的状态：
步骤9.2、执行人工鱼觅食行为：
在第i条人工鱼当前状态Xi视野范围内，利用rand()函数随机选择一个觅食状态Xj，
Xj＝Xi+Visual×Rand() (20)
分别计算Xi与Xj目标函数Yi与Yj，如果Yj比Yi好，则Xi向Xj的方向移动一位：
否则，Xi继续在其视野内选择状态Xj，判断是否满足前进条件，反复尝试 try-number＝10次后，仍没有满足前进条件，则执行步骤9.1。
步骤9.3、执行人工鱼聚群行为：
①设第i条人工鱼当前状态为Xi，计算第i条人工鱼Xi与第j条人工鱼之间的距 离为dij，得到第i条人工鱼Xi与鱼群中所有人工鱼之间的距离Di。其中， dij＝||Xi-Xj||(1≤i≤N,1≤j≤N)，Di＝(di1,di2,…,din)
②搜索该人工鱼Xi当前视野内(dij＜Visual)的伙伴数目nf，并计算周围伙伴的当前状态(Xi1,Xi2,…,Xin)，以及中心位置Xc。
③计算中心状态Xc的食物浓度Yc，判断中心状态Xc的食物浓度Yc是否大于第i 条人工鱼Xi的食物浓度Yi，若满足Yc/nf＞δ×Yi，则表明伙伴中心位置状态 较优且不太拥挤，则Xi朝伙伴的中心位置移动一步
否则执行步骤9.2。
步骤9.4、执行人工鱼追尾行为：
①设第i条人工鱼当前状态为Xi，计算Xi当前视野内(dij＜Visual)其他人工鱼的数目nf以及对应的食物浓度(Yi1,Yi2,…,Yin)，找到食物浓度最大的人工鱼Xj；
②搜索该人工鱼Xj当前视野内(dij＜Visual)的其他人工鱼数目m；
③判断该人工鱼Xj的食物浓度Yj是否大于第i条人工鱼Xi的食物浓度Yi，若满 足Yj/m＞δ×Yi，则表明最优人工鱼Xj的周围不太拥挤，则Xi朝最优人工鱼 Xj位置移动一步
否则执行步骤9.2。
步骤10、每条人工鱼执行一次后，检验自身状态，若食物浓度优于公告牌，则将 该人工鱼的食物浓度和当前状态更新到公告牌；
步骤11、令i＝i+1，如果满足i＝lmax＝30，则达到最大迭代次数，输出公告牌 上的人工鱼状态Xbest及对应食物浓度Ybest，即一子级回收航迹设计中盘旋削高阶段的 最优进入点坐标，结束；否则跳转执行步骤9。
步骤12、将步骤11输出的最优参数带入一子级回收规划的航迹中去，计算径向 飞行阶段、盘旋削高阶段、逆风着陆阶段以及雀降阶段的航迹设计参数。
步骤13、将步骤12计算出的一子级各阶段航迹规划参数带入步骤1中的一子级-翼伞六自由度模型中，仿真调试，显示一子级回收航迹规划结果。
结果说明：
从图4能够看出，本实施例一子级回收航迹优化目标函数值随迭代次数的增加不断减小，最终稳定在0.08附近，经过17次的迭代完成一子级回收航迹参数的优化， 最终得到的寻优参数为：一子级回收航迹盘旋削高阶段最佳切入点坐标为 R* ET＝140m,θ* ET＝20.37°，盘旋阶段转弯圆弧的度数为β4＝339.63°；径向飞行阶段的 距离||BC||＝2205m。
由图6和图7能够看出，分段归航方法规划一子级回收航迹，一子级的着落偏差 为11.18m，本实施例航迹规划方法设计一子级航迹，一子级的着陆偏差为5.38m，着 陆精度上提高了1倍；由图5能够看出，分段归航方法在盘旋阶段的盘旋半径为 R＝110m，对应的翼伞系统控制量u＝0.11，持续时间为569s，消耗能量为6.88；本实 施例寻找的盘旋阶段最优半径为R＝140m，对应的翼伞系统控制量为u＝0.08，持续 585s，消耗能量为4.22。综上所述，本发明在保证一子级航迹落点精度的条件下，通 过建立一子级归航航迹多目标函数约束条件，对归航过程系统能量损耗进行了有效约 束；引入人工鱼群算法的觅食、聚群、追尾等行为，加快了一子级回收航迹规划中参 数寻优的收敛速度，提高了最优参数的求解精度，使一子级归航过程系统能量消耗同 时达到最少。
Claims (1)
1.一种运载火箭一子级伞控回收航迹规划方法，其特征在于包括以下步骤：
步骤一、建立一子级-翼伞系统归航过程六自由度数学模型，系统的十二个微分方程如下：
一子级-翼伞系统动力学方程：
一子级-翼伞系统角运动方程如下：
一子级-翼伞系统的姿态角与角速度之间关系如下：
一子级-翼伞系统质心在地面坐标系中的位置关系如下：
其中，一子级-翼伞系统总质量m＝mw+mc+mf，mw,mc,mf分别为火箭一子级质量、翼伞质量和系统附加质量；x,y,z分别是一子级-翼伞系统的位移；u,v,w分别表示一子级-翼伞速度在体坐标系内沿x轴、y轴、z轴的速度分量；pc、qc、rc分别是一子级-翼伞绕x轴、y轴和z轴的角速度分量；φc、θc、ψc分别是一子级-翼伞的滚转角、俯仰角、偏航角；(Ixx、Iyy、Izz)，(L、M、N)，(Mx、My、Mz)分别为系统在各轴上的转动惯量、气动力矩和重力力矩；
在翼伞系统控制下，火箭一子级做稳定滑翔运动，在受到重力和气动力的平衡作用后，系统水平飞行速度vl和垂直下降速度vz保持不变，此时，将一子级-翼伞系统六自由度模型简化为质点模型；取坐标系为大地坐标系，坐标原点为航迹规划的目标点，得到的系统质点模型为，
式中，ψ，
分别为一子级-翼伞系统飞行过程中的转弯角度、转弯角速度，u表示系统控制量；
步骤二、结合一子级-翼伞系统模型仿真获取的系统飞行特性，对一子级回收航迹进行划分，将归航航迹划分为径向飞行段、盘旋削高段、逆风着陆段和雀降段四个过程；
步骤三、建立一子级回收过程各段航迹的位置和长度的几何关系；在径向飞行阶段，过渡圆弧圆心坐标O1为：
径向飞行段的位移即为
之间的距离为：
径向飞行阶段
与X轴正向夹角为：
圆弧O1对应的圆心角β1：
在盘旋削高阶段，过渡圆弧对应的圆心O2坐标为：
过渡圆弧O2对应的圆心角β2为：
圆弧O3对应的圆心角β3为：
β3＝-α3-s×θET，若β3<0，β3＝β3+2π (13)
在逆风接近阶段，过渡圆弧O4的夹角β4为：
其中，Rmin表示一子级回收航迹中AB段、CD段、EF段的转弯半径；β1，β2，β4分别表示一子级返回航迹中转弯段对应的圆弧段弧度；RET表示盘旋阶段DE的盘旋半径；β3表示盘旋阶段对应的圆弧段弧度；θET表示盘旋削高阶段的方位角；
α0表示初始位置对应的方位角；
步骤四、一子级回收航迹规划的关键是盘旋削高阶段的进入点(RET,θET)的确定；根据一子级-翼伞系统的质点模型，以及评价航迹的标准，建立目标函数为：
式中，Rmin表示一子级回收航迹中过渡圆弧段的转弯半径；RET表示盘旋阶段的盘旋半径，||BC||表示一子级返回中滑翔段在水平面内投影的距离；β1，β2，β3，β4表示一子级归航航迹中转弯段对应的圆弧段弧度；k为一子级-翼伞系统稳定飞行时的滑翔比，z0为翼伞系统开始工作时一子级的高度；
F1表示一子级着陆时的偏差，即设计的一子级航迹的水平飞行距离与定滑翔比条件下初始高度对应的水平飞行距离(k·z0)的差值的绝对值；F2表示一子级回收过程消耗的能量，u表示翼伞系统的控制量，大小与系统的转弯半径有关；
F＝min{k1|Y1|+k2|Y2|} (17)
F表示F1、F2的加权求和，k1、k2为比例系数,将F1、F2优化至相同量纲；
设定航迹规划约束条件为：盘旋阶段的盘旋半径RET∈[R1,R2]，R1,R2为一子级-翼伞模型的转弯半径的上、下限；盘旋削高阶段进入点C长度||OC||∈[R1,R2]，方位角θET∈[-π,π]；
步骤五、设置人工鱼群参数，人工鱼个体的状态表示为向量X＝(x1,x2,…,xn)，其中xi(i＝1,…,n)即寻优的变量；人工鱼当前位置的食物浓度表示为Y＝f(X)，其中，Y为目标函数值；设置人工鱼的规模N、状态维数n、边界范围[bmin,bmax]；人工鱼的视野范围Visual、人工鱼移动的最大步长Step、人工鱼拥挤度因子δ，人工鱼搜索食物浓度的尝试次数try-number和最大迭代次数lmax；
步骤六、引入Rand()随机函数产生n行，N＝列的0～1之间的随机数，初始化鱼群，生成N条人工鱼；
xki＝bmin k+Rand()×(bmaxk-bmink) (18)
其中，bmin，bmax为寻优参数的取值下限、上限，k＝1,2…n；Rand()为生成一个0～1之间均匀分布的随机函数；
步骤七、公告牌初始化，计算出当前状态下鱼群中各条人工鱼的食物浓度Y＝(y1,y2,…,yn)，逐个比较目标值，将最优的人工鱼状态放入公告牌中；
步骤八、执行单次迭代寻优，当前状态人工鱼i；
步骤九、对每条人工鱼进行评价，对其要执行的行为进行选择；在人工鱼随机行为中，第i条人工鱼Xi视野范围内的觅食状态为：
在人工鱼觅食行为中，第i条人工鱼Xi视野范围内，产生觅食状态Xj，比较Xi、Xj的目标函数Yi、Yj的大小，选择下一步移动状态，
在人工鱼聚群行为中，计算第i条人工鱼Xi与第j条人工鱼之间的距离dij以及与鱼群中所有人工鱼之间的距离Di，其中，dij＝||Xi-Xj||(1≤i≤N,1≤j≤N)，Di＝(di1,di2,…,din)；搜索该人工鱼Xi当前视野内的伙伴数目nf，并计算周围伙伴的当前状态(Xi1,Xi2,…,Xin)，以及中心位置Xc，其中，
然后判断中心状态Xc的食物浓度Yc与第i条人工鱼Xi的食物浓度Yi的关系，若满足Yc/nf>δ×Yi，Xi朝伙伴的中心位置移动一步
在人工鱼追尾行为中，计算Xi当前视野内其他人工鱼的数目nf以及对应的食物浓度(Yi1,Yi2,…,Yin)，找到食物浓度最大的人工鱼Xj；搜索人工鱼Xj当前视野内的其他人工鱼数目m；若人工鱼Xj的食物浓度Yj大于人工鱼Xi的食物浓度Yi，即满足Yj/m>δ×Yi，则Xi朝最优人工鱼Xj位置移动一步
步骤十、每条人工鱼执行一次后，检验自身状态，若食物浓度优于公告牌，则将该人工鱼的食物浓度和当前状态更新到公告牌；
步骤十一、依次执行所有的人工鱼，直到达到最大迭代次数，输出公告牌上的人工鱼状态Xbest及对应食物浓度Ybest，即一子级回收航迹设计中盘旋阶段的最优进入点坐标；
步骤十二、将计算的最优航迹参数带入一子级回收规划的航迹中，计算径向飞行阶段、盘高阶段、逆风着陆阶段以及雀降阶段的航迹设计参数；
步骤十三、将一子级各阶段航迹设计参数带入一子级-翼伞六自由度模型中，仿真调试，显示一子级回收航迹规划结果。
Priority Applications (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201911126635.5A CN111046486B (zh) | 2019-11-18 | 2019-11-18 | 运载火箭一子级伞控回收航迹规划方法 |
Applications Claiming Priority (1)
| Application Number | Priority Date | Filing Date | Title |
|---|---|---|---|
| CN201911126635.5A CN111046486B (zh) | 2019-11-18 | 2019-11-18 | 运载火箭一子级伞控回收航迹规划方法 |
Publications (2)
| Publication Number | Publication Date |
|---|---|
| CN111046486A true CN111046486A (zh) | 2020-04-21 |
| CN111046486B CN111046486B (zh) | 2022-05-03 |
Family
ID=70232806
Family Applications (1)
| Application Number | Title | Priority Date | Filing Date |
|---|---|---|---|
| CN201911126635.5A Active CN111046486B (zh) | 2019-11-18 | 2019-11-18 | 运载火箭一子级伞控回收航迹规划方法 |
Country Status (1)
| Country | Link |
|---|---|
| CN (1) | CN111046486B (zh) |
Cited By (5)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN112182957A (zh) * | 2020-09-15 | 2021-01-05 | 西北工业大学 | 一种基于天牛群算法的一子级伞控回收航迹规划方法 |
| CN112395697A (zh) * | 2020-10-29 | 2021-02-23 | 北京空间机电研究所 | 一种降落伞柔性绳带阻尼系数的获取方法 |
| CN116244836A (zh) * | 2023-03-21 | 2023-06-09 | 蓝箭航天空间科技股份有限公司 | 基于adams的运载火箭起飞漂移安全间隙设计方法 |
| CN116700308A (zh) * | 2023-06-15 | 2023-09-05 | 南京航空航天大学 | 基于粒子群优化算法的翼伞系统分段归航轨迹规划方法 |
| CN116909168A (zh) * | 2023-09-13 | 2023-10-20 | 北京航空航天大学 | 一种基于模型预测控制的精准空投系统自主归航控制方法 |
Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20160027311A1 (en) * | 2014-07-24 | 2016-01-28 | The Charles Stark Draper Laboratory, Inc. | Methods and systems for wind mitigation in autonomous parafoil guidance |
| CN106651021A (zh) * | 2016-12-16 | 2017-05-10 | 新疆疆天航空科技有限公司 | 基于精英人工鱼群的植保无人机编队航迹规划方法 |
| CN107121940A (zh) * | 2017-05-27 | 2017-09-01 | 南京航空航天大学 | 一种翼伞四自由度半实物仿真平台 |
| CN107392388A (zh) * | 2017-07-31 | 2017-11-24 | 南昌航空大学 | 一种采用改进人工鱼群算法规划无人机三维航迹的方法 |
| CN109307511A (zh) * | 2018-09-04 | 2019-02-05 | 山东理工大学 | 一种人工鱼群算法优化的容积粒子滤波导航方法 |
| CN110162077A (zh) * | 2019-06-18 | 2019-08-23 | 哈尔滨工程大学 | 一种基于飞鱼算法的无人机航迹规划方法 |
-
2019
- 2019-11-18 CN CN201911126635.5A patent/CN111046486B/zh active Active
Patent Citations (6)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| US20160027311A1 (en) * | 2014-07-24 | 2016-01-28 | The Charles Stark Draper Laboratory, Inc. | Methods and systems for wind mitigation in autonomous parafoil guidance |
| CN106651021A (zh) * | 2016-12-16 | 2017-05-10 | 新疆疆天航空科技有限公司 | 基于精英人工鱼群的植保无人机编队航迹规划方法 |
| CN107121940A (zh) * | 2017-05-27 | 2017-09-01 | 南京航空航天大学 | 一种翼伞四自由度半实物仿真平台 |
| CN107392388A (zh) * | 2017-07-31 | 2017-11-24 | 南昌航空大学 | 一种采用改进人工鱼群算法规划无人机三维航迹的方法 |
| CN109307511A (zh) * | 2018-09-04 | 2019-02-05 | 山东理工大学 | 一种人工鱼群算法优化的容积粒子滤波导航方法 |
| CN110162077A (zh) * | 2019-06-18 | 2019-08-23 | 哈尔滨工程大学 | 一种基于飞鱼算法的无人机航迹规划方法 |
Non-Patent Citations (2)
| Title |
|---|
| JIN TAO等: "CPSO based optimization in multiphase homing trajectory of powered parafoils with insufficient altitude", 《2016 35TH CHINESE CONTROL CONFERENCE (CCC)》 * |
| 金焱骅 等: "ESPSO在翼伞气动参数辨识中的应用", 《仪器仪表学报》 * |
Cited By (9)
| Publication number | Priority date | Publication date | Assignee | Title |
|---|---|---|---|---|
| CN112182957A (zh) * | 2020-09-15 | 2021-01-05 | 西北工业大学 | 一种基于天牛群算法的一子级伞控回收航迹规划方法 |
| CN112182957B (zh) * | 2020-09-15 | 2022-05-03 | 西北工业大学 | 一种基于天牛群算法的一子级伞控回收航迹规划方法 |
| CN112395697A (zh) * | 2020-10-29 | 2021-02-23 | 北京空间机电研究所 | 一种降落伞柔性绳带阻尼系数的获取方法 |
| CN112395697B (zh) * | 2020-10-29 | 2024-02-09 | 北京空间机电研究所 | 一种降落伞柔性绳带阻尼系数的获取方法 |
| CN116244836A (zh) * | 2023-03-21 | 2023-06-09 | 蓝箭航天空间科技股份有限公司 | 基于adams的运载火箭起飞漂移安全间隙设计方法 |
| CN116244836B (zh) * | 2023-03-21 | 2024-05-07 | 蓝箭航天空间科技股份有限公司 | 基于adams的运载火箭起飞漂移安全间隙设计方法 |
| CN116700308A (zh) * | 2023-06-15 | 2023-09-05 | 南京航空航天大学 | 基于粒子群优化算法的翼伞系统分段归航轨迹规划方法 |
| CN116909168A (zh) * | 2023-09-13 | 2023-10-20 | 北京航空航天大学 | 一种基于模型预测控制的精准空投系统自主归航控制方法 |
| CN116909168B (zh) * | 2023-09-13 | 2023-12-01 | 北京航空航天大学 | 一种基于模型预测控制的精准空投系统自主归航控制方法 |
Also Published As
| Publication number | Publication date |
|---|---|
| CN111046486B (zh) | 2022-05-03 |
Similar Documents
| Publication | Publication Date | Title |
|---|---|---|
| CN111046486B (zh) | 运载火箭一子级伞控回收航迹规划方法 | |
| CN112182957B (zh) | 一种基于天牛群算法的一子级伞控回收航迹规划方法 | |
| CN108319286A (zh) | 一种基于强化学习的无人机空战机动决策方法 | |
| CN111694375B (zh) | 翼伞系统航迹规划方法和系统、航迹跟踪控制方法和系统 | |
| CN114840020A (zh) | 一种基于改进鲸鱼算法的无人机飞行轨迹规划方法 | |
| CN111880555A (zh) | 翼伞系统避障航迹规划方法和系统 | |
| CN113625740A (zh) | 一种基于迁移学习鸽群优化的无人机空战博弈方法 | |
| Peng et al. | Analysis of morphing modes of hypersonic morphing aircraft and multiobjective trajectory optimization | |
| Dong et al. | Trial input method and own-aircraft state prediction in autonomous air combat | |
| Yoo et al. | Deep reinforcement learning-based intelligent agent for autonomous air combat | |
| Yang et al. | An aerodynamic shape optimization study to maximize the range of a guided missile | |
| CN116700308A (zh) | 基于粒子群优化算法的翼伞系统分段归航轨迹规划方法 | |
| CN116954239A (zh) | 一种基于改进粒子群算法的无人机航迹规划方法及系统 | |
| CN116560249A (zh) | 一种机动飞行的高自由度简化建模与轨迹仿真方法 | |
| CN116520883A (zh) | 一种复杂空域环境下翼伞系统归航轨迹规划方法 | |
| CN110532614B (zh) | 一种旋转导弹转速特性气动优化方法 | |
| Wang et al. | Study on fuzzy neural sliding mode guidance law with terminal angle constraint for maneuvering target | |
| CN115510910A (zh) | 一种优化飞行模拟器动感模拟算法中的滤波器参数的方法 | |
| CN114662285A (zh) | 一种高速飞行器火力控制模型的智能解算方法 | |
| CN114815875A (zh) | 一种基于集合满射鸽群智能优化的无人机集群编队控制器调参方法 | |
| Ma et al. | Research on the design of smart morphing long-endurance UAVs | |
| Guzelbey et al. | A Review of Aerodynamic Shape Optimization for a Missile | |
| Tanil et al. | External configuration optimization of missiles in conceptual design | |
| Dong et al. | Maneuvering Strategy and Own Aircraft Movement Prediction in Trial Input Method----Low Angle of Attack | |
| CN113311871B (zh) | 跳跃-滑翔导弹的制导律优化方法及系统 |
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 |