CN111077903A - 一种基于窗口决策的高容错性的天钩回收方法 - Google Patents
一种基于窗口决策的高容错性的天钩回收方法 Download PDFInfo
- Publication number
- CN111077903A CN111077903A CN201911273230.4A CN201911273230A CN111077903A CN 111077903 A CN111077903 A CN 111077903A CN 201911273230 A CN201911273230 A CN 201911273230A CN 111077903 A CN111077903 A CN 111077903A
- Authority
- CN
- China
- Prior art keywords
- unmanned aerial
- aerial vehicle
- section
- window
- recovery
- 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 143
- 238000000034 method Methods 0.000 title claims abstract description 36
- 230000001133 acceleration Effects 0.000 claims description 9
- 230000008859 change Effects 0.000 claims description 6
- 230000005484 gravity Effects 0.000 claims description 3
- 229910000831 Steel Inorganic materials 0.000 claims description 2
- 238000005096 rolling process Methods 0.000 claims description 2
- 239000010959 steel Substances 0.000 claims description 2
- 238000007726 management method Methods 0.000 description 66
- 238000010586 diagram Methods 0.000 description 3
- 230000008569 process Effects 0.000 description 3
- 238000004064 recycling Methods 0.000 description 3
- 241000209094 Oryza Species 0.000 description 2
- 235000007164 Oryza sativa Nutrition 0.000 description 2
- 235000009566 rice Nutrition 0.000 description 2
- 230000007704 transition Effects 0.000 description 2
- 230000009194 climbing Effects 0.000 description 1
- 230000000694 effects Effects 0.000 description 1
- 239000004576 sand Substances 0.000 description 1
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
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)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Navigation (AREA)
Abstract
本发明公开一种基于窗口决策的高容错性的天钩回收方法,具体为:无人机飞至返航飞行段的终点后,进入能量管理段;能量管理段设置的能量管理窗口判断无人机是否可以进入末端撞线段,如果可以,则进入末端撞线段;否则无人机按照能量管理段的路径继续循环飞行,直至通过该窗口;当无人机飞至末端撞线段中的下滑段的终点后,无人机飞进回收决策窗口,回收决策窗口判断无人机是否能进行撞线,如果可以则无人机通过平飞段进入复飞决策窗口;否则无人机进入平飞段并通过第一复飞段重新进入能量管理段;复飞决策窗口判断无人机是否撞线成功,如果是,则发动机熄火;否则无人机通过第二复飞段进入能量管理段。本发明具有精确度高等优点。
Description
技术领域
本发明涉及天钩回收制导技术领域,尤其涉及一种基于窗口决策的高容错性的天钩回收方法。
背景技术
目前常用的回收方式有常规跑道回收、伞降回收、垂直着陆回收、撞网回收及天钩回收等等。这些方法存在精确度低、对无人机的要求较高、容易造成无人机的损害等问题。
发明内容
发明目的:为解决现有技术中存在精确度低等问题,本发明提供一种基于窗口决策的高容错性的天钩回收方法。
技术方案:本发明提供一种基于窗口决策的高容错性的天钩回收方法,该方法具体包括如下步骤:
步骤1:根据无人机的转弯半径、回收点D以及回收方向将回收路段分为:返航飞行段、能量管理段、末端撞线段;所述末端撞线段包括下滑段和末端平飞段;
步骤2,无人机飞至返航飞行段的终点后,进入能量管理段;
步骤3,能量管理段中设有能量管理窗口,当无人机飞进能量管理窗口时,能量管理窗口判断无人机是否可以进入末端撞线段,如果可以,则进入末端撞线段,并转步骤4,否则无人机按照能量管理段的路径继续在能量管理段循环飞行,直至通过决策窗口,并转步骤4;
步骤4:所述末端平飞段包括依次设置的回收决策窗口、平飞段和复飞决策窗口和,当无人机飞至下滑段的终点后,进入末端平飞段,当无人机飞进回收决策窗口时,回收决策窗口判断无人机是否能进行撞线,如果可以则无人机通过平飞段进入复飞决策窗口,并转步骤5;否则无人机进入平飞段并通过第一复飞段重新进入能量管理段,并转步骤3;
步骤5:复飞决策窗口判断无人机是否能撞线成功,如果是,则发动机熄火,回收完毕;否则无人机通过第二复飞段进入能量管理段,并转步骤3;
步骤6:根据回收点以及回收航向的变化,除能量管理窗口,无人机其他航线上时实时更新整个无人机的航路。
进一步的,所述步骤1中,具体划分能量管理段的方法为:根据回收点D的坐标(x,y,z)、能量管理段的起点WPE1与回收点D的水平距离D1,以及预设好的WPE1距离地面的高度He,确定能量管理段的起点WPE1的坐标,所述WPE1与回收点D在z轴上的坐标值相同,所述D1的长度为:
其中dEW、dEW1、dEW2分别为能量管理窗口的长度、回收决策窗口的长度、复飞决策窗口的长度,dEW=dEW1=dEW2=T*V,T为时间,V为无人机的速度;He=50~100m,Hr为回收点D距离地面高度,γ为无人机的下滑角,其中为无人机的最大下沉率,Vtas为无人机的真空速,Rt为无人机的转弯半径:
以与WPE1在y,z轴坐标上的值相同,按照回收方向在与WPE1距离3Rt+dEW处设置航点WPE2;以与WPE2在x,y轴坐标上的值相同,按照逆时针的方向在与WPE2距离3Rt处设置航点WPE3,以与WPE3在y,z轴坐标上的值相同,按照回收方向的反方向在与WPE3距离3Rt+dEW处设置航点WPE4;所述WPE1、WPE2、WPE3、WPE4构成的矩形为能量管理段;无人机在能量管理段飞行时依次根据航点WPE1、WPE2、WPE3、WPE4飞行。
进一步的,所述步骤1中,返航飞行段的确定方法为:
以无人机在定滚转角盘旋的转弯半径R为半径,根据点WPE1,在WPE1的x轴与y轴的平面上确定一个圆,且WPE1与该圆的圆心的连线与地面垂直,根据如下公式在该圆上找到切点WPR1的坐标(xR1,yR1);
其中(x0,y0)为圆心的坐标,(xA,yA)为无人机返航初始位置A的坐标;
按照回收方向,返航飞行段由A→WPR1的线段、以及WPR1→WPE1的圆弧段构成。
进一步的,所述步骤1中,末端撞线段的确定方法为:
将能量管理窗口的终点设为末端撞线段的起点WPH1;所述能量管理窗口设置在WPE1与WPE2构成的航线上,且起点与WPE1之间的距离为2Rt;根据半径R1、点WPH1,确定一个圆,且该圆的圆心位于点WPH1的正下方,按照回收方向在该圆上设置航点WPH3,使得WPH3与圆心构成的线段和WPH1与圆心构成的线段之间的夹角为γ;半径R1为:
根据回收方向,设置一条经过点WPH3,且与地面的夹角为γ的直线Q;在该直线距离地面Hr+10m处设置航点WPH4;根据直线Q与回收点D的水平线,得到一条与直线Q、回收点D的水平线均相切的圆弧,且该圆弧与直线Q的切点为WPH4;在该圆弧与回收点D的水平线上的切点处设置航点WPH6;
按照回收方向,下滑段由WPH1→WPH3的圆弧段、WPH3→WPH4的直线下滑段、WPH4→WPH6的圆弧段构成;WPH6→D为末端平飞段,所述回收决策窗口和复飞决策窗口为一段水平航线;所述回收决策窗口的起点设置在航点WPH6处,所述复飞决策窗口的中点设置在回收点D处,所述平飞段为由回收决策窗口的终点至复飞决策窗口起点的一段水平航线,平飞段的长度为Rt。
进一步的,所述步骤5和步骤6中的第一、二复飞段的具体确定方法如下所示:
第一复飞段:以在距离复飞决策窗口的起点的正上方Hr-He处设置航点WPG1;以与WPG1在x,y轴上的值相同,按照WPE2→WPE3的方向,在与WPG1距离3Rt处设置航点WPG2;则在第一复飞段,无人机进入平飞段后依次根据航点WPG1、WPG2、WPE3飞进能量管理段;并按照能量管理段的方向飞行;
第二复飞段:以与WPG1在z,y轴的值相等,按照回收方向,在与复飞决策窗口的终点水平距离Rt处设置航点WPG3;以与WPG3在x,y轴上的值相同,按照WPE2→WPE3的方向,在与WPG3距离3Rt处设置航点WPG4;则在第二复飞段,无人机依次根据航点WPG3、WPG4、WPG2、WPE3飞进能量管理段;并按照能量管理段的方向飞行。
进一步的,根据如下公式确定无人机在横侧向采用的模态:
|psivpre-psivnow|≤15°
其中pisvpre为上上个航点到上一个航点的航线角,pisvnow为上一个航点到当前待飞航点的航线角,当无人机即将飞至当前待飞航点,若两个航线角之间满足上述公式,则在当前航段中无人机横侧向采用直线跟踪策略进入下一段航路;若不符则采用圆弧跟踪策略进入下一段航路;无人机的横向制导律如下所示:
进一步的,当无人机未能通过回收决策窗口或复飞决策窗口时,无人机采用定空速爬升通过第一复飞段或第二复飞段爬升至与能量管理端相同高度的位置,在其他回收阶段无人机的纵向飞行策略均采用定高平飞的策略,无人机的纵向制导律为:
进一步的,所述能量管理窗口通过如下公式判断无人机是否可以进入末端撞线段:
其中,ΔY为无人机的侧偏差、ΔH为无人机的高度差,W为无人机翼展长度,U为无人机安全撞线的高度范围;若无人机在能量管理窗口中满足上述公式,则能量管理窗口判定无人机可以进入末端撞线段。
进一步的,所述回收决策窗口通过如下公式判断无人机是否能进行撞线:
若无人机在回收决策窗口中满足上述公式,则回收决策窗口判定无人机可以进行撞线。
进一步的,所述复飞决策窗口通过如下公式判断无人机是否能撞线成功:
VG<Vs
其中,Ax为无人机的轴向加速度、Ay为无人机的侧向加速度、VG为无人机相对于地面的速度,VS为失速速度,ah为常数;若无人机在复飞决策窗口中满足上述公式中的任意一个,则复飞决策窗口判定无人机撞线成功。
有益效果:
1、本发明适用于舰载无人机天钩回收段制导,满足无人机天钩回收高精度和特定方向的回收需求,并设定了回收判断窗口以及复飞航路和逻辑,结合了侧偏以及高度精确控制的制导方法,提高了了无人机天钩回收的可靠性。
2、本发明是一种基于动态航路生成的天钩回收制导方法,在无人机的横侧向内进行动态的航路规划及生成;本发明通过多次无人机的天钩回收飞行应用试验,验证了本发明方法的有效性。
附图说明
图1为本实施例的返航飞行段示意图;
图2为末端撞线段侧视图;
图3为无人机回收航路的俯视图和侧视图;
图4为本实施例的流程图;
图5为横侧向制导回路图;
图6为纵向制导回路图。
具体实施方式
构成本发明的一部分的附图用来提供对本发明的进一步理解,本发明的示意性实施例及其说明用于解释本发明,并不构成对本发明的不当限定。
本实施例提供一种基于窗口决策的高容错性的天钩回收方法。本发明根据回收点提供的回收点位置以及回收方向,再结合无人机当前位置,可以唯一确定一个回收航路,如图4所示,本实施例具体包括如下所示:
步骤1、将整个回收段航路分为返航飞行段、能量管理段、末端撞线段;
步骤2、在无人机完成巡航任务或者收到“返航”指令时,无人机确定返航飞行段的圆心,计算出返航的切点WPR1,在进入返航圆弧后调整无人机飞行航向与回收航向一致;无人机飞至返航飞行段的终点后,进入能量管理段;
步骤3、能量管理段,包含WPE1、WPE2、WPE3、WPE4等航点,其主要作用是保证无人机的能量已经调整到能够进行下滑的状态,其中设置了一个能量管理窗口,当无人机飞进能量管理窗口时,能量管理窗口判断无人机是否可以进入末端撞线段,如果可以,则进入末端撞线段,并转步骤4,否则无人机按照能量管理段的路径继续在能量管理段循环飞行,直至通过决策窗口,并转步骤4。
步骤4、末端撞线段,包含了WPH1、WPH3、WPGH4、WPH6、D等航点,其中WPH1→WPH3→WPH4→WPH6为下滑段的航路,D为回收点,WPH6→D为末端平飞段。末端平飞段还包含了回收决策窗口和复飞决策窗口;当无人机飞至下滑段的终点后,进入末端平飞段,当无人机飞进回收决策窗口时,回收决策窗口判断无人机是否能进行撞线,如果可以则无人机通过平飞段进入复飞决策窗口,并转步骤5;否则无人机进入平飞段并通过第一复飞段重新进入能量管理段,并转步骤3。
步骤5、复飞决策窗口判断无人机是否能撞线成功,如果是,则发动机熄火,回收完毕;否则无人机通过第二复飞段进入能量管理段,并转步骤3。
步骤6、根据回收点以及回收航向的变化,需要实时更新整个无人机的回收航路。
在回收过程中,要求无人机能够准确压航线飞行,所以采用控制侧偏以及高度的制导方法。如回收点在一个运动目标上,如舰船或者回收车上,则需要对回收航路进行实时更新,保证无人机能够实时跟踪目标航线。
当无人机不处于末端撞线段时,即无人机尚未通过能量管理窗口或者在进行复飞时,考虑到回收点行进速度相对无人机较小,因此按照1分钟一次的频率调整航路。还需注意的是,为避免影响窗口决策的判断,在无人机通过能量管理窗口的过程中,不能更新航线。
当无人机回收处于末端撞线段时,此时对航路实时性要求更高,在此阶段时,回收段航路每50ms更新一次。无人机通过给定上述动态航路生成,完成外回路制导,实现精确回收。
返航飞行段:基于回收段的位置确定,从回收点往回收方向反向的方向能够找到航点WPE1(能量管理段的起点、返航飞行段的终点),无人机在定滚转角盘旋的转弯半径R已知,可以得到返航圆弧的圆心位置,进而计算出返航切点的WPR1位置。
航点WPE1的具体确定方法为:根据回收点D的坐标(x,y,z)、能量管理段的起点WPE1与回收点D的水平距离D1,以及预设好的WPE1距离地面的高度He,确定能量管理段的起点WPE1的坐标,所述WPE1与回收点D在z轴上的坐标值相同。
返航飞行段是无人机进入回收段的入口,无人机想要进行回收都需要进入返航飞行段,返航飞行段将无人机调整到一个合适的位置和高度,准备进行回收段逻辑的执行。如图1所示,以R为半径,根据点WPE1,在WPE1的x轴与y轴的平面上确定一个圆,且WPE1与该圆的圆心的连线与地面垂直,根据如下公式在该圆上找到切点WPR1的坐标(xR1,yR1):
其中(x0,y0)为圆心的坐标,(xA,yA)为无人机返航初始位置A的坐标;按照回收方向,如图1所示,返航飞行段由A→WPR1的线段、以及WPR1→WPE1的圆弧段构成。
如图3所示,量管理段由WPE1、WPE2、WPE3、WPE4四个航点组成,该四个航点处在同一高度,且按照WPE1→WPE2→WPE3→WPE4的方向为逆时针方向;能量管理段有两个作用,第一是将无人机的能量调整到能够进行下滑的状态,无人机的能量主要体现在飞行高度以及飞行速度上;第二能量管理段设置了能量管理窗口,用于判断无人机能量是否已经达到能够下滑的状态,若是,则可进入末端撞线段,否则需要继续绕能量管理段飞行调整无人机状态。根据无人机以及撞线的具体条件设定能量管理段窗口的判断条件,无人机翼展为W米,无人机安全撞线的高度范围为U米。能量管理窗口通过如下公式判断无人机是否可以进入末端撞线段:
其中,ΔY为侧偏差、ΔH为高度差,可根据无人机特性的不同修改窗口的大小。
如图2所示末端撞线段由WPH1、WPH3、WPH4、WPH6、D五个个航点组成,其中WPH1→WPH3→WPH4→WPH6为下滑部分的航路。WPH1→WPH3阶段为下滑圆弧过渡、WPH3→WPH4阶段为直线下滑、WPH4→WPH6为指数拉起阶段;WPH6→D为末端平飞段。
末端撞线段的作用是将无人机的高度调整到与回收点高度一致以及将侧偏差尽量消除,达到横侧向的精确跟踪。在末端平飞段有两个窗口:回收决策窗口和复飞决策窗口。所述回收决策窗口的起点设置在航点WPH6处,所述复飞决策窗口的中点设置在回收点D处,所述由回收决策窗口的终点至复飞决策窗口起点的一条水平航线为平飞段。若无人机通过回收决策窗口,会进入平飞段,进行撞线操作,否则无人机会通过WPG1→WPG2→WPE3→WPE4→WPE1航点进入能量管理段的第一个航点。若通过复飞决策窗口时,无人机检测到撞线成功,则发动机熄火;否则无人机会通过WPG3→WPG4→WPG2→WPE3→WPE4→WPE1等航点回到能量管理段的第一个航点。基于天钩回收的原理,ΔY最大不能超过无人机机翼翼展的一半,ΔH的限定与回收装置有关,可根据实际情况进行修改。回收决策窗口的判断条件为:
其中,Ax为轴向加速度、Ay为侧向加速度。无人机是否成功挂钩可以从过载和地速VG两方面来判断。在撞线时,由于无人机的航迹会发生很大的变化,所以拦阻绳对无人机的力有一部分会作用在无人机的侧向,选用轴向过载与侧向过载的平方和作为判断依据;ah为常数,与无人机撞线速度V以及回收装置的特性有关;为了增加安全裕度,避免过载信号漏判造成撞线结果的误判,当无人机的地速小于失速速度VS,认为无人机撞线成功。
若无人机在复飞决策窗口中满足上述公式中的任意一个,则复飞决策窗口判定无人机撞线成功。
复飞段由WPG1、WPG2、WPG3、WPG4等航点组成,与能量管理段的航路一起构成两个矩形。主要作用是提供一条可靠的轨迹让无人机重新进入能量管理段。同时,在无人机复飞的过程中还需要进行爬升,使无人机回到能量管理段的高度。
现依照图3对回收航路各航点的位置进行说明。决策窗口的判断需要一定的时间,将能量管理窗口的长度、回收决策窗口的长度、复飞决策窗口的长度:dEW、dEW1、dEW2设置为2V米,V为无人机的速度,故每个窗口有2s的时间进行判断。
回收点D的位置在复飞决策窗口的中间,L1的长度设置为V米;为了保证进行撞线前复飞时不撞到回收装置,设置L2的长度为Rt米,Rt为无人机的转弯半径;能量管理段后先进行下滑过渡,使无人机能够平滑进入直线下滑轨迹,提前量长度设置为Rt/2米;故整个下滑段WPH1→WPH6水平长度为则:
为了保证无人机能进行最短路径飞行,将L4的长度设定为Rt米,
L3的长度可通过上式计算出;无人机转弯后,留一个转弯半径的长度进行调整,进入能量管理窗口,L5长度设定为2Rt米;能量管理段宽度设定为3Rt米,
则D1的长度为:
确定WPE1、WPE2、WPE3、WPE4四个航点的位置:以与WPE1在y,z轴坐标上的值相同,按照回收方向在与WPE1距离3Rt+dEW处设置航点WPE2;以与WPE2在x,y轴坐标上的值相同,按照逆时针的方向在与WPE2距离3Rt处设置航点WPE3,以与WPE3在y,z轴坐标上的值相同,按照回收方向的反方向在与WPE3距离3Rt+dEW处设置航点WPE4;所述WPE1、WPE2、WPE3、WPE4构成的矩形为能量管理段;无人机在能量管理段飞行时依次根据航点WPE1、WPE2、WPE3、WPE4飞行。
具体确定末端撞线端的方法为:将能量管理窗口的终点设为末端撞线段的起点WPH1;所述能量管理窗口设置在WPE1与WPE2构成的航线上,且起点与WPE1之间的距离为2Rt;根据半径R1、点WPH1,确定一个圆,且该圆的圆心位于点WPH1的正下方,按照回收方向在该圆上设置航点WPH3,使得WPH3与圆心构成的线段和WPH1与圆心构成的线段之间的夹角为γ;半径R1为:
根据回收方向,设置一条经过点WPH3,且与地面的夹角为γ的直线Q;在该直线距离地面Hr+10m处设置航点WPH4;根据直线Q与回收点D的水平线,得到一条与直线Q、回收点D的水平线均相切的圆弧,且该圆弧与直线Q的切点为WPH4;在该圆弧与回收点D的水平线上的切点处设置航点WPH6;
当无人机按照WPH1→WPH3的圆弧飞行时,无人的坐标(x1,h)满足如下公式:
(x1-XO1)2+(h-XO1)2=R12
其中(XO1,HO1)为根据半径R1、点WPH1,确定一个圆的圆心
当无人机按照WPH3→WPH4飞行的时候,飞行的高度轨迹为:
Hg=He-Xtanγ
其中,X为无人机位置与图2中点WPH2在沿着回收方向上的水平距离。
当无人机按照WPH4→WPH6飞行的时候,其飞行的高度轨迹为:
其中,X1为无人机位置与D点在沿着回收方向上的水平距离。
第一复飞段:以在距离复飞决策窗口的起点的正上方Hr-He处设置航点WPG1;以与WPG1在x,y轴上的值相同,按照WPE2→WPE3的方向,在与WPG1距离3Rt处设置航点WPG2;则在第一复飞段,无人机进入平飞段后依次根据航点WPG1、WPG2、WPE3飞进能量管理段;并按照能量管理段的方向飞行。
第二复飞段:以与WPG1在z,y轴的值相等,按照回收方向,在与复飞决策窗口的终点水平距离Rt处设置航点WPG3;以与WPG3在x,y轴上的值相同,按照WPE2→WPE3的方向,在与WPG3距离3Rt处设置航点WPG4;则在第二复飞段,无人机依次根据航点WPG3、WPG4、WPG2、WPE3飞进能量管理段;并按照能量管理段的方向飞行。
在天钩回收的过程中,无人机横侧向主要包含两种模态,直线航迹跟踪以及圆弧航迹跟踪,判断该航段采用的跟踪策略的方法为:
|psivpre-psivnow|≤15°
pisvpre表示前前航点到前一航点的航线角,pisvnow表示前一航点到当前待飞航点的航线角。若满足上式,即两个航段的航段角之差小于等于15°则当前航段采用直线跟踪策略,若航段角之差大于15°则当前航段采用圆弧跟踪策略。回收航路来说,需要拐弯的时候则为圆弧航迹跟踪,不需要拐弯的时候为直线航迹跟踪。直线跟踪与圆弧跟踪的控制结构相同,都是以控制侧偏和航迹角进行纠偏,且采用以控制航迹角为主,侧偏为辅的策略。其制导回路如图5所示
横侧向制导律为:
无人机的纵向主要采用定高平飞以及定空速爬升两种策略。当无人机未能通过回收决策窗口以及复飞决策窗口时,无人机需要先爬升到与能量管理段同高的位置,此时无人机的纵向飞行策略为定空速爬升。保证空速的同时,无人机的迎角以及爬升角都处于一个比较稳定的状态,能有效保证无人机的安全。在回收的其他阶段,为了达到精确航迹跟踪的目的,无人机的纵向飞行策略均采用定高平飞的策略,最外环为高度差,姿态环为无人机的俯仰角,增稳环控制无人机的俯仰角速率。在无人机进行末端撞线的下滑部分的时候,采用的也是该种策略。导回路如图6所示;
纵向制导律为:
另外需要说明的是,在上述具体实施方式中所描述的各个具体技术特征,在不矛盾的情况下,可以通过任何合适的方式进行组合。为了避免不必要的重复,本发明对各种可能的组合方式不再另行说明。
Claims (10)
1.一种基于窗口决策的高容错性的天钩回收方法,其特征在于,该方法具体包括如下步骤:
步骤1:根据无人机的转弯半径、回收点D以及回收方向将回收路段分为:返航飞行段、能量管理段、末端撞线段;所述末端撞线段包括下滑段和末端平飞段;
步骤2,无人机飞至返航飞行段的终点后,进入能量管理段;
步骤3,能量管理段中设有能量管理窗口,当无人机飞进能量管理窗口时,能量管理窗口判断无人机是否可以进入末端撞线段,如果可以,则进入末端撞线段,并转步骤4,否则无人机按照能量管理段的路径继续在能量管理段循环飞行,直至通过决策窗口,并转步骤4;
步骤4:所述末端平飞段包括依次设置的回收决策窗口、平飞段和复飞决策窗口,当无人机飞至下滑段的终点后,进入末端平飞段,当无人机飞进回收决策窗口时,回收决策窗口判断无人机是否能进行撞线,如果可以则无人机通过平飞段进入复飞决策窗口,并转步骤5;否则无人机进入平飞段并通过第一复飞段重新进入能量管理段,并转步骤3;
步骤5:复飞决策窗口判断无人机是否能撞线成功,如果是,则发动机熄火,回收完毕;否则无人机通过第二复飞段进入能量管理段,并转步骤3;
步骤6:根据回收点以及回收航向的变化,除能量管理窗口,无人机在其他航线上时实时更新整个无人机的航路。
2.根据权利要求1所述的一种基于窗口决策的高容错性的天钩回收方法,其特征在于,所述步骤1中,具体划分能量管理段的方法为:根据回收点D的坐标(x,y,z)、能量管理段的起点WPE1与回收点D的水平距离D1,以及预设好的WPE1距离地面的高度He,确定能量管理段的起点WPE1的坐标,所述WPE1与回收点D在z轴上的坐标值相同,所述D1的长度为:
其中dEW、dEW1、dEW2分别为能量管理窗口的长度、回收决策窗口的长度、复飞决策窗口的长度,dEW=dEW1=dEW2=T*V,T为时间,V为无人机的速度;He=50~100m,Hr为回收点D距离地面高度,γ为无人机的下滑角,其中为无人机的最大下沉率,Vtas为无人机的真空速,Rt为无人机的转弯半径:
以与WPE1在y,z轴坐标上的值相同,按照回收方向在与WPE1距离3Rt+dEW处设置航点WPE2;以与WPE2在x,y轴坐标上的值相同,按照逆时针的方向在与WPE2距离3Rt处设置航点WPE3,以与WPE3在y,z轴坐标上的值相同,按照回收方向的反方向在与WPE3距离3Rt+dEW处设置航点WPE4;所述WPE1、WPE2、WPE3、WPE4构成的矩形为能量管理段;无人机在能量管理段飞行时依次根据航点WPE1、WPE2、WPE3、WPE4飞行。
4.根据权利要求3所述的一种基于窗口决策的高容错性的天钩回收方法,其特征在于,所述步骤1中,末端撞线段的确定方法为:
将能量管理窗口的终点设为末端撞线段的起点WPH1;所述能量管理窗口设置在WPE1与WPE2构成的航线上,且起点与WPE1之间的距离为2Rt;根据半径R1、点WPH1,确定一个圆,且该圆的圆心位于点WPH1的正下方,按照回收方向在该圆上设置航点WPH3,使得WPH3与圆心构成的线段和WPH1与圆心构成的线段之间的夹角为γ;半径R1为:
根据回收方向,设置一条经过点WPH3,且与地面的夹角为γ的直线Q;在该直线距离地面Hr+10m处设置航点WPH4;根据直线Q与回收点D的水平线,得到一条与直线Q、回收点D的水平线均相切的圆弧,且该圆弧与直线Q的切点为WPH4;在该圆弧与回收点D的水平线上的切点处设置航点WPH6;
按照回收方向,下滑段由WPH1→WPH3的圆弧段、WPH3→WPH4的直线下滑段、WPH4→WPH6的圆弧段构成;WPH6→D为末端平飞段,所述回收决策窗口和复飞决策窗口为一段水平航线;所述回收决策窗口的起点设置在航点WPH6处,所述复飞决策窗口的中点设置在回收点D处,所述平飞段为回收决策窗口的终点至复飞决策窗口起点的一段水平航线,平飞段的长度为Rt。
5.根据权利要求4所述的一种基于窗口决策的高容错性的天钩回收方法,其特征在于,所述步骤5和步骤6中的第一、二复飞段的具体确定方法如下所示:
第一复飞段:以在距离复飞决策窗口的起点的正上方Hr-He处设置航点WPG1;以与WPG1在x,y轴上的值相同,按照WPE2→WPE3的方向,在与WPG1距离3Rt处设置航点WPG2;则在第一复飞段,无人机进入平飞段后依次根据航点WPG1、WPG2、WPE3飞进能量管理段;并按照能量管理段的方向飞行;
第二复飞段:以与WPG1在z,y轴的值相等,按照回收方向,在与复飞决策窗口终点的水平距离为Rt处设置航点WPG3;以与WPG3在x,y轴上的值相同,按照WPE2→WPE3的方向,在与WPG3距离3Rt处设置航点WPG4;则在第二复飞段,无人机依次根据航点WPG3、WPG4、WPG2、WPE3飞进能量管理段;并按照能量管理段的方向飞行。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911273230.4A CN111077903B (zh) | 2019-12-12 | 2019-12-12 | 一种基于窗口决策的高容错性的天钩回收方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201911273230.4A CN111077903B (zh) | 2019-12-12 | 2019-12-12 | 一种基于窗口决策的高容错性的天钩回收方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111077903A true CN111077903A (zh) | 2020-04-28 |
CN111077903B CN111077903B (zh) | 2021-11-16 |
Family
ID=70314111
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201911273230.4A Active CN111077903B (zh) | 2019-12-12 | 2019-12-12 | 一种基于窗口决策的高容错性的天钩回收方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111077903B (zh) |
Cited By (3)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113190024A (zh) * | 2021-03-31 | 2021-07-30 | 成都飞机工业(集团)有限责任公司 | 一种有人驾驶固定翼飞机空滑迫降决策与引导方法 |
CN114020014A (zh) * | 2021-10-27 | 2022-02-08 | 中国船舶工业系统工程研究院 | 无人机回收过程航线规划控制方法、装置、设备及介质 |
CN117270566A (zh) * | 2023-10-11 | 2023-12-22 | 中国科学院力学研究所 | 一种无人机下滑道切入制导方法 |
Citations (23)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8028952B2 (en) * | 2008-03-31 | 2011-10-04 | The Boeing Company | System for shipboard launch and recovery of unmanned aerial vehicle (UAV) aircraft and method therefor |
US8464981B2 (en) * | 2011-01-26 | 2013-06-18 | Infoscitex Corporation | Unmanned aerial vehicle(UAV) recovery system |
CN104443413A (zh) * | 2013-09-14 | 2015-03-25 | 惠铁军 | 无人飞机回收设备 |
US9073645B2 (en) * | 2012-06-20 | 2015-07-07 | Raytheon Company | Apparatus and method for retrieving unmanned aerial vehicles |
CN204775989U (zh) * | 2015-05-26 | 2015-11-18 | 合肥赛为智能有限公司 | 一种适于撞绳式回收的无人机机翼 |
CN105897483A (zh) * | 2016-05-25 | 2016-08-24 | 浙江大学 | 基于物联网的飞机故障实时监控与定位系统及方法 |
CN106043308A (zh) * | 2015-04-08 | 2016-10-26 | 罗伯特·博世有限公司 | 用于对汽车驾驶员进行专注性识别的方法和设备 |
US20170021943A1 (en) * | 2013-03-14 | 2017-01-26 | Aurora Flight Sciences Corporation | Capturing Hook for Aerial System |
CN106379552A (zh) * | 2016-09-26 | 2017-02-08 | 华东电子工程研究所(中国电子科技集团公司第三十八研究所) | 基于系留气球的小型无人机收放方法 |
CN106681355A (zh) * | 2015-11-05 | 2017-05-17 | 空中客车运营简化股份公司 | 用于在进场阶段协助飞行器航行以管理能量的方法和装置 |
US20170308104A1 (en) * | 2016-04-20 | 2017-10-26 | Worcester Polytechnic Institute | Airborne vehicle recovery |
JP2018047898A (ja) * | 2013-12-30 | 2018-03-29 | エックス デベロップメント エルエルシー | 横風飛行とホバー飛行の間で航空車両を移行させる方法およびシステム |
CN107933925A (zh) * | 2017-12-06 | 2018-04-20 | 哈尔滨工业大学 | 一种缆绳浮标勾取式空中低速无人机无损回收系统及方法 |
CN108255192A (zh) * | 2017-12-08 | 2018-07-06 | 中国航空工业集团公司成都飞机设计研究所 | 一种小型舰载无人机回收航路规划管理方法 |
US20180203470A1 (en) * | 2017-01-17 | 2018-07-19 | Valeo North America, Inc. | Autonomous security drone system and method |
CN207748037U (zh) * | 2017-12-26 | 2018-08-21 | 航天神舟飞行器有限公司 | 一种适用于无人机天钩回收的回收钩 |
WO2018189324A1 (en) * | 2017-04-12 | 2018-10-18 | Norwegian University Of Science And Technology (Ntnu) | Recovery system for uav |
CN109358645A (zh) * | 2018-11-19 | 2019-02-19 | 南京航空航天大学 | 一种小型舰载无人机自适应绳钩回收制导航路及制导方法 |
CN109460054A (zh) * | 2018-09-11 | 2019-03-12 | 成都优艾维智能科技有限责任公司 | 一种针对直流单回耐张塔的无人机自主巡检方法 |
CN109573088A (zh) * | 2018-10-29 | 2019-04-05 | 南京航空航天大学 | 一种舰载无人机光电引导着舰系统及着舰方法 |
CN109752955A (zh) * | 2018-12-18 | 2019-05-14 | 南京航空航天大学 | 基于二维位置引导的飞行器轨迹跟踪与抗扰控制系统及方法 |
CN109933088A (zh) * | 2019-03-18 | 2019-06-25 | 西安爱生技术集团公司 | 一种适用于双模回收的无人机航线自动生成方法 |
CN110530374A (zh) * | 2019-10-08 | 2019-12-03 | 西安爱生技术集团公司 | 一种无人机天钩回收阶段航迹偏差显示方法 |
-
2019
- 2019-12-12 CN CN201911273230.4A patent/CN111077903B/zh active Active
Patent Citations (23)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US8028952B2 (en) * | 2008-03-31 | 2011-10-04 | The Boeing Company | System for shipboard launch and recovery of unmanned aerial vehicle (UAV) aircraft and method therefor |
US8464981B2 (en) * | 2011-01-26 | 2013-06-18 | Infoscitex Corporation | Unmanned aerial vehicle(UAV) recovery system |
US9073645B2 (en) * | 2012-06-20 | 2015-07-07 | Raytheon Company | Apparatus and method for retrieving unmanned aerial vehicles |
US20170021943A1 (en) * | 2013-03-14 | 2017-01-26 | Aurora Flight Sciences Corporation | Capturing Hook for Aerial System |
CN104443413A (zh) * | 2013-09-14 | 2015-03-25 | 惠铁军 | 无人飞机回收设备 |
JP2018047898A (ja) * | 2013-12-30 | 2018-03-29 | エックス デベロップメント エルエルシー | 横風飛行とホバー飛行の間で航空車両を移行させる方法およびシステム |
CN106043308A (zh) * | 2015-04-08 | 2016-10-26 | 罗伯特·博世有限公司 | 用于对汽车驾驶员进行专注性识别的方法和设备 |
CN204775989U (zh) * | 2015-05-26 | 2015-11-18 | 合肥赛为智能有限公司 | 一种适于撞绳式回收的无人机机翼 |
CN106681355A (zh) * | 2015-11-05 | 2017-05-17 | 空中客车运营简化股份公司 | 用于在进场阶段协助飞行器航行以管理能量的方法和装置 |
US20170308104A1 (en) * | 2016-04-20 | 2017-10-26 | Worcester Polytechnic Institute | Airborne vehicle recovery |
CN105897483A (zh) * | 2016-05-25 | 2016-08-24 | 浙江大学 | 基于物联网的飞机故障实时监控与定位系统及方法 |
CN106379552A (zh) * | 2016-09-26 | 2017-02-08 | 华东电子工程研究所(中国电子科技集团公司第三十八研究所) | 基于系留气球的小型无人机收放方法 |
US20180203470A1 (en) * | 2017-01-17 | 2018-07-19 | Valeo North America, Inc. | Autonomous security drone system and method |
WO2018189324A1 (en) * | 2017-04-12 | 2018-10-18 | Norwegian University Of Science And Technology (Ntnu) | Recovery system for uav |
CN107933925A (zh) * | 2017-12-06 | 2018-04-20 | 哈尔滨工业大学 | 一种缆绳浮标勾取式空中低速无人机无损回收系统及方法 |
CN108255192A (zh) * | 2017-12-08 | 2018-07-06 | 中国航空工业集团公司成都飞机设计研究所 | 一种小型舰载无人机回收航路规划管理方法 |
CN207748037U (zh) * | 2017-12-26 | 2018-08-21 | 航天神舟飞行器有限公司 | 一种适用于无人机天钩回收的回收钩 |
CN109460054A (zh) * | 2018-09-11 | 2019-03-12 | 成都优艾维智能科技有限责任公司 | 一种针对直流单回耐张塔的无人机自主巡检方法 |
CN109573088A (zh) * | 2018-10-29 | 2019-04-05 | 南京航空航天大学 | 一种舰载无人机光电引导着舰系统及着舰方法 |
CN109358645A (zh) * | 2018-11-19 | 2019-02-19 | 南京航空航天大学 | 一种小型舰载无人机自适应绳钩回收制导航路及制导方法 |
CN109752955A (zh) * | 2018-12-18 | 2019-05-14 | 南京航空航天大学 | 基于二维位置引导的飞行器轨迹跟踪与抗扰控制系统及方法 |
CN109933088A (zh) * | 2019-03-18 | 2019-06-25 | 西安爱生技术集团公司 | 一种适用于双模回收的无人机航线自动生成方法 |
CN110530374A (zh) * | 2019-10-08 | 2019-12-03 | 西安爱生技术集团公司 | 一种无人机天钩回收阶段航迹偏差显示方法 |
Non-Patent Citations (15)
Title |
---|
H. JIN KIM等: "Fully Autonomous Vision-Based Net-Recovery Landing System for a Fixed-Wing UAV", 《IEEE/ASME TRANSACTIONS ON MECHATRONICS》 * |
KHANTSIS S, BOURMISTROVA A: "Stochastic Design of a Non-Linear Controller for Autonomous UAV Recovery", 《PROCEEDING OF INTERNATIONAL CONGRESS ON MODELLING AND SIMULATION》 * |
KRISTIAN KLAUSEN,JOSTEIN BORGEN MOE: "Coordinated control concept for recovery of a fixed-wing UAV on a ship using a net carried by multirotor UAVs", 《2016 INTERNATIONAL CONFERENCE ON UNMANNED AIRCRAFT SYSTEMS (ICUAS)》 * |
WEIWEI KONG等: "Autonomous landing of an UAV with a ground-based actuated infrared stereo vision system", 《2013 IEEE/RSJ INTERNATIONAL CONFERENCE ON INTELLIGENT ROBOTS AND SYSTEMS》 * |
XI JINCHENG,LI CHUNTAO,CHENG ZUNKUN: "Fault Handling Logic for Sky Hook Recycling Drone Sensor Failure", 《2019 5TH INTERNATIONAL CONFERENCE ON CONTROL SCIENCE AND SYSTEMS ENGINEERING (ICCSSE)》 * |
卢伟,马晓平,周明,孙林峰: "无人机绳钩回收系统的动力学特性仿真分析", 《航空学报》 * |
周敏,周军,郭建国: "RLV末端能量管理段轨迹在线规划与制导", 《宇航学报》 * |
张媛媛: "无人机无动力应急着陆控制技术研究", 《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》 * |
李娜,等: "一种RLV末端能量管理段的轨迹实时规划方法", 《装备指挥技术学院学报》 * |
甄子洋,陶钢,江驹,王新华: "无人机自动撞网着舰轨迹自适应跟踪控制", 《哈尔滨工程大学学报》 * |
甄子洋: "舰载无人机自主着舰回收制导与控制研究进展", 《自动化学报》 * |
童中翔等: "基于能量控制方法的航天器TAEM制导仿真", 《导弹与航天运载技术》 * |
胡孟权: "RLV末端能量管理段轨迹实时生成算法研究", 《飞行力学》 * |
臧希恒等: "亚轨道飞行器能量管理段轨迹设计", 《航空学报》 * |
裴锦华,何成,王陶,李悦: "小型固定翼无人机绳钩回收过程动力学分析", 《南京航空航天大学学报》 * |
Cited By (5)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113190024A (zh) * | 2021-03-31 | 2021-07-30 | 成都飞机工业(集团)有限责任公司 | 一种有人驾驶固定翼飞机空滑迫降决策与引导方法 |
CN114020014A (zh) * | 2021-10-27 | 2022-02-08 | 中国船舶工业系统工程研究院 | 无人机回收过程航线规划控制方法、装置、设备及介质 |
CN114020014B (zh) * | 2021-10-27 | 2023-08-15 | 中国船舶工业系统工程研究院 | 无人机回收过程航线规划控制方法、装置、设备及介质 |
CN117270566A (zh) * | 2023-10-11 | 2023-12-22 | 中国科学院力学研究所 | 一种无人机下滑道切入制导方法 |
CN117270566B (zh) * | 2023-10-11 | 2024-08-20 | 中国科学院力学研究所 | 一种无人机下滑道切入制导方法 |
Also Published As
Publication number | Publication date |
---|---|
CN111077903B (zh) | 2021-11-16 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111077903B (zh) | 一种基于窗口决策的高容错性的天钩回收方法 | |
EP2817689B1 (en) | Safe emergency landing of a uav | |
US6963795B2 (en) | Vehicle position keeping system | |
CN111650958B (zh) | 一种固定翼无人机起飞段切入航路点的在线路径规划方法 | |
CN109917812A (zh) | 高空高速无人机着陆接地状态控制方法 | |
CN110908405B (zh) | 一种固定翼无人机进行同心圆飞行时的控制方法 | |
CN101763116A (zh) | 一种基于侧向导引的抗侧风着陆航迹跟踪控制方法 | |
CN108319284B (zh) | 一种适用于障碍物环境的无人机下滑段轨迹设计方法 | |
CN111580547B (zh) | 一种高超声速飞行器编队控制方法 | |
CN105844972A (zh) | 一种直升机前视地形告警方法 | |
CN107870629A (zh) | 增强的起飞系统 | |
US11535394B2 (en) | Aircraft landing assistance method and memory storage device including instructions for performing an aircraft landing assistance method | |
EP3037345A1 (en) | A method of automatically controlling the descent phase of an aircraft using aircraft avionics executing a descent algorithm | |
CN112009698B (zh) | 一种用于高超声速巡航飞行器的返航飞行能量管理方法 | |
CN110322733A (zh) | 一种侧向跑道保护区到达起飞窗建立方法 | |
JP5585455B2 (ja) | 経路探索装置 | |
RU2747587C1 (ru) | Способ посадки беспилотного вертолета на движущееся судно | |
KR101702573B1 (ko) | 진보된 파라포일 공중운송시스템 | |
RU2242800C2 (ru) | Способ захода на посадку | |
JP5166349B2 (ja) | 固定翼機、固定翼機システムおよび固定翼機の着陸方法 | |
CN116243719A (zh) | 一种无人机盘旋陡降着陆控制方法及控制系统 | |
US20230206774A1 (en) | Method and system for assisting with the approach of an aircraft with a view to landing | |
RU2002132246A (ru) | Способ захода на посадку | |
CN105786020B (zh) | 一种无人机的短距滑降方法 | |
RU2364943C1 (ru) | Способ выполнения захода на посадку |
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 |