CN109933088A - 一种适用于双模回收的无人机航线自动生成方法 - Google Patents
一种适用于双模回收的无人机航线自动生成方法 Download PDFInfo
- Publication number
- CN109933088A CN109933088A CN201910205720.4A CN201910205720A CN109933088A CN 109933088 A CN109933088 A CN 109933088A CN 201910205720 A CN201910205720 A CN 201910205720A CN 109933088 A CN109933088 A CN 109933088A
- Authority
- CN
- China
- Prior art keywords
- point
- recycling
- latitude
- rectangular
- longitude coordinates
- 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
Landscapes
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
- Position Fixing By Use Of Radio Waves (AREA)
Abstract
本发明提供了一种适用于双模回收的无人机航线自动生成方法,根据跑道、绳钩回收车位置和方向信息以及窗口点和着陆点信息等自动生成绳钩回收和滑跑回收航线,引导无人机安全回收。本发明提出的跑道和绳钩双模回收航线自动生成方法,与之前的手动回收航线规划方式相比,由于利用了飞机或绳钩回收车在回收场地的位置信息从而计算出了需要的回收参数,不再需要人工进行估算,提高了回收航线的精确度以及无人机回收的安全性和可靠性;同时本发明在接受了回收场地参数后自动生成回收航线,免除了操作员在图上作业的不便,极大地提高了工作效率。
Description
技术领域
本发明涉及无人机航线规划领域,尤其是一种无人机航线的自动生成方法。
背景技术
随着无人机相关技术的发展,根据无人机自身特性,回收方式也趋于多样化。相比于起飞,无人机回收是一个更为复杂和容易出现故障的阶段,能否安全着陆已经成为了评价无人机性能的一项重要指标。目前无人机的回收方式主要有滑轮着陆、伞降回收、撞网回收、绳钩回收等。将其中两种回收模式应用到一种无人机中是无人机回收的发展趋势。
同一种无人机既可以绳钩回收又可以滑轮着陆回收,可根据天气、场地、空间等条件灵活地选择回收模式,极大地提高了无人机着陆的安全性。当无人机执行完任务准备返航时,操纵员根据当时的条件选择绳钩或滑轮着陆的一种进行手动规划回收航线,费时费力且精确度不高。为降低无人机操作手的工作负荷,提高工作效率和可靠性,迫切的需要研究一种适用于绳钩和跑道双模回收的无人机航线自动生成方法,而目前未见相关的双模回收航线自动生成方法。
发明内容
为了克服现有技术的不足,本发明提供一种适用于绳钩和跑道双模回收的无人机航线自动生成方法,根据跑道、绳钩回收车位置和方向信息以及窗口点和着陆点信息等自动生成绳钩回收和滑跑回收航线,引导无人机安全回收。
本发明解决其技术问题所采用的技术方案的步骤如下:
步骤1:获取无人机在跑道上的初始点S点的经纬度坐标(Ls,Bs)和差分GPS高度Hs,获取方向点D点的经纬度坐标(LD,BD),方向点D点为无人机沿跑道滑行2至3公里所到达的位置,根据高斯坐标转换公式,将初始点经纬度坐标(Ls,Bs),转换为平面直角坐标下的位置(Xs,Ys),并将方向点经纬度坐标(LD,BD),转换为平面直角坐标下的位置(XD,YD),根据初始点和方向点的位置计算出跑道方向角α,即跑道与正北方向的夹角为:
步骤2:操作员输入滑跑回收时无人机的着陆点与初始点之间的距离DSL,根据高斯坐标转换公式,将初始点经纬度坐标(Ls,Bs),转换为平面直角坐标下的位置(Xs,Ys),用初始点位置(Xs,Ys),距离DSL以及跑道方向角α计算出着陆点L点位置(XL,YL)为:
将着陆点位置(XL,YL)转换成经纬度坐标(LL,BL);
步骤3:获取撞线点H点经纬度坐标(LH,BH),方向点D点经纬度坐标(LVD,BVD),其中撞线点为无人机撞线时绳钩回收车的位置,方向点为绳钩回收车沿着车头方向行驶1公里所到达的位置,根据高斯坐标转换公式,将撞线点经纬度坐标(LH,BH),转换为平面直角坐标下的位置(XH,YH),并将方向点经纬度坐标(LVD,BVD),转换为平面直角坐标下的位置(XVD,YVD),根据撞线点和方向点的位置计算出绳钩回收方向角β,方向角β为无人机撞线回收时的航线方向与正北方向的夹角,计算公式为:
操作员输入绳钩回收航线窗口点wC点至撞线点H点的水平距离D2ToH,如图4所示);
步骤4:系统指挥员根据场地、空间、飞机状态条件选择回收模式,若准备回收前机场跑道、飞机起落架准备就绪,则选择滑轮着陆,若回收空间有限或回收场地不允许着陆回收,则选择绳钩回收,若为滑轮着陆,则进入跑道回收航线自动规划流程,即进入步骤5;若为绳钩回收,则进入绳钩回收航线自动规划流程,即进入步骤6;
步骤5:若为跑道回收,则依据以下步骤进行:
步骤5.1:回收航线规划模块接受跑道回收参数:跑道方向角α,着陆点经纬度坐标(LL,BL),跑道回收航线进入点SR点至窗口点wR点的距离D1To2,差分GPS高度Hs,将着陆点经纬度坐标(LL,BL),转换为平面直角坐标下的位置(XL,YL);
步骤5.2:跑道回收从正向和逆向两个方向进行,正向回收方向角α′=α,逆向回收方向角α′=α+π,可生成正向和逆向两条跑道回收航线;
步骤5.3:跑道回收航线为4个航点组成的折线,其中SR点为航线进入点,WR点为窗口点,L点为着陆点,C点为纠偏点,SR点和WR点相对跑道的高度均为h,依次生成4个航点的经纬度以及SR点和WR点的高度:
步骤5.3.1:计算SR点直角坐标位置:
将SR点直角坐标(XSR,YSR)转换成经纬度坐标(LSR,BSR),SR点高度为:HSR=Hs+h;
步骤5.3.2:计算窗口点wR点的直角坐标位置:
将wR点直角坐标(XWR,YWR)转换成经纬度坐标(LWR,BWR),wR点高度:HWR=Hs+h;
步骤5.3.3:着陆点L点的经纬度坐标为(LL,BL);
步骤5.3.4:计算C点直角坐标位置:将C点直角坐标(XC,YC)转换成经纬度坐标(LC,BC);
由此生成跑道回收航线;
步骤6:若为绳钩回收,则依据以下步骤进行:
步骤6.1:接受绳钩回收参数:撞线点H点经纬度坐标(LH,BH),绳钩回收方向角β,绳钩回收航线窗口点wC点至撞线点H点的水平距离D2ToH,差分GPS高度Hs,将撞线点经纬度坐标(LH,BH),转换为平面直角坐标下的位置(XH,YH);
步骤6.2:撞线回收从正向和逆向两个方向进行,正向回收方向角β′=β,逆向回收方向角β′=β+π,生成正向和逆向两条撞线回收航线;
步骤6.3:撞线回收航线为6个航点组成的折线,其中SC点为航线进入点,WC点为窗口点,无人机在wC与A1点之间撞线回收,若无人机没有成功撞线回收,则进入A1、A2、A3、A4点进行复飞调整,然后再进入SC点重新准备撞线回收;6个航点相对回收场地的高度均为h,依次生成6个航点的经纬度和高度;
步骤6.3.1:计算SC点直角坐标位置:
将SC点直角坐标(XSC,YSC)转换成经纬度坐标(LSC,BSC);
步骤6.3.2:计算WC点直角坐标位置:
将wC点直角坐标(XWC,YWC)转换成经纬度坐标(LWC,BWC);
步骤6.3.3:计算A1点直角坐标位置:
将A1点直角坐标(XA1,YA1)转换成经纬度坐标(LA1,BA1);
步骤6.3.4:计算A2点直角坐标位置:
将A2点直角坐标(XA2,YA2)转换成经纬度坐标(LA2,BA2);
步骤6.3.5:计算A3点直角坐标位置:
将A3点直角坐标(XA3,YA3)转换成经纬度坐标(LA3,BA3);
步骤6.3.6:计算A4点直角坐标位置:将A4点直角坐标(XA4,YA4)转换成经纬度坐标(LA4,BA4);
步骤6.3.7:6个航点的高度均为H=Hs+h;
由此生成绳钩回收航线。
本发明的有益效果在于本发明提出的跑道和绳钩双模回收航线自动生成方法,与之前的手动回收航线规划方式相比,由于利用了飞机或绳钩回收车在回收场地的位置信息从而计算出了需要的回收参数,不再需要人工进行估算,提高了回收航线的精确度以及无人机回收的安全性和可靠性;同时本发明在接受了回收场地参数后自动生成回收航线,免除了操作员在图上作业的不便,极大地提高了工作效率。
附图说明
图1为本发明的跑道回收信息示意图。
图2为本发明的绳钩回收信息示意图。
图3为本发明的跑道回收自动生成航线侧视图。
图4为本发明的绳钩回收自动生成航线三维图。
图5为本发明的双模回收航线自动生成实现流程图。
具体实施方式
下面结合附图和实施例对本发明进一步说明。
步骤1:获取无人机在跑道上的初始点S点的经纬度坐标(Ls,Bs)和差分GPS高度Hs,获取方向点D点的经纬度坐标(LD,BD),方向点D点为无人机沿跑道滑行2至3公里所到达的位置,根据高斯坐标转换公式,将初始点经纬度坐标(Ls,Bs),转换为平面直角坐标下的位置(Xs,ys),并将方向点经纬度坐标(LD,BD),转换为平面直角坐标下的位置(XD,YD),如图1所示,根据初始点和方向点的位置计算出跑道方向角α,即跑道与正北方向的夹角为:
步骤2:操作员输入滑跑回收时无人机的着陆点与初始点之间的距离DSL,根据高斯坐标转换公式,将初始点经纬度坐标(Ls,Bs),转换为平面直角坐标下的位置(Xs,Ys),用初始点位置(Xs,Ys),距离DSL以及跑道方向角α计算出着陆点L点位置(XL,YL)为:
将着陆点位置(XL,YL)转换成经纬度坐标(LL,BL),如图2所示。
步骤3:获取撞线点H点经纬度坐标(LH,BH),方向点D点经纬度坐标(LVD,BVD),其中撞线点为无人机撞线时绳钩回收车的位置,方向点为绳钩回收车沿着车头方向行驶1公里所到达的位置,根据高斯坐标转换公式,将撞线点经纬度坐标(LH,BH),转换为平面直角坐标下的位置(XH,YH),并将方向点经纬度坐标(LVD,BVD),转换为平面直角坐标下的位置(XVD,YVD),根据撞线点和方向点的位置计算出绳钩回收方向角β,方向角β为无人机撞线回收时的航线方向与正北方向的夹角,计算公式为:
操作员输入绳钩回收航线窗口点wC点至撞线点H点的水平距离D2ToH,如图4所示);
步骤4:系统指挥员根据场地、空间、飞机状态条件选择回收模式,若准备回收前机场跑道、飞机起落架准备就绪,则选择滑轮着陆,若回收空间有限或回收场地不允许着陆回收,则选择绳钩回收,若为滑轮着陆,则进入跑道回收航线自动规划流程,即进入步骤5;若为绳钩回收,则进入绳钩回收航线自动规划流程,即进入步骤6;
步骤5:若为跑道回收,则依据以下步骤进行:
步骤5.1:回收航线规划模块接受跑道回收参数:跑道方向角α,着陆点经纬度坐标(LL,BL),跑道回收航线进入点SR点至窗口点wR点(如图3所示,)的距离D1To2,差分GPS高度Hs,将着陆点经纬度坐标(LL,BL),转换为平面直角坐标下的位置(XL,YL);
步骤5.2:跑道回收从正向和逆向两个方向进行,正向回收方向角α′=α,逆向回收方向角α′=α+π,可生成正向和逆向两条跑道回收航线;
步骤5.3:跑道回收航线为4个航点组成的折线,如图3所示,其中SR点为航线进入点,WR点为窗口点,L点为着陆点,C点为纠偏点,SR点和WR点相对跑道的高度均为h,依次生成4个航点的经纬度以及SR点和WR点的高度:
步骤5.3.1:计算SR点直角坐标位置:
将SR点直角坐标(XSR,YSR)转换成经纬度坐标(LSR,BSR),SR点高度为:HSR=Hs+h;
步骤5.3.2:计算窗口点wR点的直角坐标位置:
将wR点直角坐标(XWR,YWR)转换成经纬度坐标(LWR,BWR),wR点高度:HWR=Hs+h;
步骤5.3.3:着陆点L点的经纬度坐标为(LL,BL);
步骤5.3.4:计算C点直角坐标位置:将C点直角坐标(XC,YC)转换成经纬度坐标(LC,BC);
由此生成跑道回收航线;
步骤6:若为绳钩回收,则依据以下步骤进行:
步骤6.1:接受绳钩回收参数:撞线点H点经纬度坐标(LH,BH),绳钩回收方向角β,绳钩回收航线窗口点wC点至撞线点H点的水平距离D2ToH(如图4所示),差分GPS高度Hs,将撞线点经纬度坐标(LH,BH),转换为平面直角坐标下的位置(XH,YH);
步骤6.2:撞线回收从正向和逆向两个方向进行,正向回收方向角β′=β,逆向回收方向角β′=β+π,生成正向和逆向两条撞线回收航线;
步骤6.3:撞线回收航线为6个航点组成的折线,如图4所示,其中SC点为航线进入点,wC点为窗口点,无人机在wC与A1点之间撞线回收,若无人机没有成功撞线回收,则进入A1、A2、A3、A4点进行复飞调整,然后再进入SC点重新准备撞线回收;6个航点相对回收场地的高度均为h,依次生成6个航点的经纬度和高度;
步骤6.3.1:计算SC点直角坐标位置:
将SC点直角坐标(XSC,YSC)转换成经纬度坐标(LSC,BSC);
步骤6.3.2:计算WC点直角坐标位置:
将wC点直角坐标(XWC,YWC)转换成经纬度坐标(LWC,BWC);
步骤6.3.3:计算A1点直角坐标位置:
将A1点直角坐标(XA1,YA1)转换成经纬度坐标(LA1,BA1);
步骤6.3.4:计算A2点直角坐标位置:
将A2点直角坐标(XA2,YA2)转换成经纬度坐标(LA2,BA2);
步骤6.3.5:计算A3点直角坐标位置:
将A3点直角坐标(XA3,YA3)转换成经纬度坐标(LA3,BA3);
步骤6.3.6:计算A4点直角坐标位置:将A4点直角坐标(XA4,YA4)转换成经纬度坐标(LA4,BA4);
步骤6.3.7:6个航点的高度均为H=Hs+h;
由此生成绳钩回收航线。
本发明实施例的详细步骤如下:
步骤1:在跑道中轴线上选择起飞点,作为无人机在跑道上的初始点S点,无人机地面站通过无人机下传数据获取初始点经纬度坐标(Ls,Bs)和差分GPS高度Hs,无人机沿着跑道中轴线滑行2至3公里在D点停止,该点作为方向点,获取方向点经纬度坐标(LD,BD)。根据高斯坐标转换公式,将初始点经纬度坐标(Ls,Bs),转换为平面直角坐标下的位置(Xs,Ys),并将方向点经纬度坐标(LD,BD),转换为平面直角坐标下的位置(XD,YD)。根据初始点和方向点的位置计算出跑道方向角α(跑道与正北方向的夹角):
计算出的方向角单位为弧度,将其换算成度输出并保存在配置文件中。
步骤2:输入滑跑回收时无人机的着陆点与初始点之间的距离DSL=500m,根据高斯坐标转换公式,将初始点经纬度坐标(Ls,Bs),转换为平面直角坐标下的位置(Xs,Ys)。用初始点位置(Xs,Ys),距离DSL以及跑道方向角α计算出着陆点位置(XL,YL):
将陆点位置(XL,YL)转换成经纬度坐标(LL,BL),保存在配置文件中。
步骤3:选择合适的撞线回收点H点,将绳钩回收车停在该点上,车头方向和撞线回收方向成直角,无人机地面站获取撞线点经纬度坐标(LH,BH),绳钩回收车沿着车头方向直线行驶1公里在D点停止,该点作为方向点,获取方向点经纬度坐标(LVD,BVD)。根据高斯坐标转换公式,将撞线点经纬度坐标(LH,BH),转换为平面直角坐标下的位置(XH,YH),并将方向点经纬度坐标(LVD,BVD),转换为平面直角坐标下的位置(XVD,YVD)。根据撞线点和方向点的位置计算出绳钩回收方向角β(无人机撞线回收时的航线方向与正北方向的夹角):
计算出的方向角单位为弧度,将其换算成度输出并保存在配置文件中。
输入绳钩回收航线窗口点wC点至撞线点H点的水平距离D2ToH=2000m,保存在配置文件中。
以上步骤1和步骤2是获取跑道信息,作为自动生成跑道回收航线的输入。步骤3是获取绳钩回收信息,作为自动生成绳钩回收航线的输入。这些信息均保存在了配置文件中,当每次飞行前地面站软件会读取配置文件数据并显示在相应界面中,若回收场地、天气情况等没有变化,不需要重新获取回收信息,则可以直接利用上次的数据作为自动生成跑道回收航线的输入。若有变化则需要重新获取回收信息。
步骤4:根据场地、空间、飞机状态等条件选择回收模式,若为滑轮着陆,则进入跑道回收航线自动规划流程;若为绳钩回收,则进入绳钩回收航线自动规划流程。
步骤5:若为跑道回收,则依据以下步骤进行:
a)接受跑道回收参数:跑道方向角α,着陆点经纬度坐标(LL,BL),跑道回收航线进入点SR点至窗口点WR点的距离D1To2=1500m,差分GPS高度Hs。将着陆点经纬度坐标(LL,BL),转换为平面直角坐标下的位置(XL,YL)。
b)跑道回收可从正向和逆向两个方向进行,正向回收方向角α′=α,逆向回收方向角α′=α+π,可生成正向和逆向两条跑道回收航线。
c)跑道回收航线为4个航点组成的折线,其中SR点为航线进入点,WR点为窗口点,L点为着陆点,C点为纠偏点,SR点和WR点相对跑道的高度均为h=100m,依次生成4个航点的经纬度以及SR点和WR点的高度。
1)计算SR点直角坐标位置:
将SR点直角坐标(XSR,YSR)转换成经纬度坐标(LSR,BSR).
SR点高度:HSR=Hs+h.
2)计算WR点直角坐标位置:
将WR点直角坐标(XWR,YWR)转换成经纬度坐标(LWR,BWR).
WR点高度:HWR=Hs+h.
3)L点为着陆点,经纬度坐标为(LL,BL).
4)计算C点直角坐标位置:
将C点直角坐标(XC,YC)转换成经纬度坐标(LC,BC).
跑道回收自动生成航线侧视示意图如图3所示。
步骤6:若为绳钩回收,则依据以下步骤进行:
a)接受绳钩回收参数:撞线点H点经纬度坐标(LH,BH),绳钩回收方向角β,绳钩回收航线窗口点WC点至撞线点H点的水平距离D2ToH,差分GPS高度Hs。将撞线点经纬度坐标(LH,BH),转换为平面直角坐标下的位置(XH,YH)。
b)撞线回收可从正向和逆向两个方向进行,正向回收方向角β′=β,逆向回收方向角β′=β+π,可生成正向和逆向两条撞线回收航线。
c)撞线回收航线为6个航点组成的折线,其中SC点为航线进入点,WC点为窗口点,无人机在WC与A1点之间撞线回收,若无人机没有成功撞线回收,则进入A1、A2、A3、A4点进行复飞调整,然后再进入SC点重新准备撞线回收。SC点至WC点的距离D1To2=1000m,WC点与撞线点H点之间的距离D2ToH=2000m,撞线点H点至A1点的距离DHro3=1000m,A1点至A2点间的距离D3To4=1000m,A2点至A3点之间的距离D4To5=1000m。其中D1To2,DHTo3,D3To4,D4To5为常数。A3点至A4点的距离等于SC点至A2点的距离,A4点至SC点的距离等于A2点至A3点的距离。6个航点相对回收场地的高度均为h=100m,依次生成6个航点的经纬度和高度。
1)计算SC点直角坐标位置:
将SC点直角坐标(XSC,YSC)转换成经纬度坐标(LSC,BSC).
2)计算WC点直角坐标位置:
将WC点直角坐标(XWC,YWC)转换成经纬度坐标(LWC,BWC).
3)计算A1点直角坐标位置:
将A1点直角坐标(XA1,YA1)转换成经纬度坐标(LA1,BA1).
4)计算A2点直角坐标位置:
将A2点直角坐标(XA2,YA2)转换成经纬度坐标(LA2,BA2).
5)计算A3点直角坐标位置:
将A3点直角坐标(XA3,YA3)转换成经纬度坐标(LA3,BA3).
6)计算A4点直角坐标位置:
将A4点直角坐标(XA4,YA4)转换成经纬度坐标(LA4,BA4).
7)6个航点的高度均为H=Hs+h;
绳钩回收自动生成航线三维示意图如图4所示。
双模回收航线自动生成实现流程图如图5所示。
本发明已经应用于某小型无人机系统中,在该系统中,本方法被包含在地面站的航迹监控软件中。航迹监控软件通过网络与数据链系统的地面数据终端进行数据交互,并通过地面数据终端向无人机发送自动生成的回收航线数据。
Claims (1)
1.一种适用于双模回收的无人机航线自动生成方法,其特征在于包括下述步骤:
步骤1:获取无人机在跑道上的初始点S点的经纬度坐标(Ls,Bs)和差分GPS高度Hs,获取方向点D点的经纬度坐标(LD,BD),方向点D点为无人机沿跑道滑行2至3公里所到达的位置,根据高斯坐标转换公式,将初始点经纬度坐标(Ls,Bs),转换为平面直角坐标下的位置(Xs,Ys),并将方向点经纬度坐标(LD,BD),转换为平面直角坐标下的位置(XD,YD),根据初始点和方向点的位置计算出跑道方向角α,即跑道与正北方向的夹角为:
步骤2:操作员输入滑跑回收时无人机的着陆点与初始点之间的距离DSL,根据高斯坐标转换公式,将初始点经纬度坐标(Ls,Bs),转换为平面直角坐标下的位置(Xs,Ys),用初始点位置(Xs,Ys),距离DSL以及跑道方向角α计算出着陆点L点位置(XL,YL)为:
将着陆点位置(XL,YL)转换成经纬度坐标(LL,BL);
步骤3:获取撞线点H点经纬度坐标(LH,BH),方向点D点经纬度坐标(LVD,BVD),其中撞线点为无人机撞线时绳钩回收车的位置,方向点为绳钩回收车沿着车头方向行驶1公里所到达的位置,根据高斯坐标转换公式,将撞线点经纬度坐标(LH,BH),转换为平面直角坐标下的位置(XH,YH),并将方向点经纬度坐标(LVD,BVD),转换为平面直角坐标下的位置(XVD,YVD),根据撞线点和方向点的位置计算出绳钩回收方向角β,方向角β为无人机撞线回收时的航线方向与正北方向的夹角,计算公式为:
操作员输入绳钩回收航线窗口点WC点至撞线点H点的水平距离D2ToH;
步骤4:系统指挥员根据场地、空间、飞机状态条件选择回收模式,若准备回收前机场跑道、飞机起落架准备就绪,则选择滑轮着陆,若回收空间有限或回收场地不允许着陆回收,则选择绳钩回收,若为滑轮着陆,则进入跑道回收航线自动规划流程,即进入步骤5;若为绳钩回收,则进入绳钩回收航线自动规划流程,即进入步骤6;
步骤5:若为跑道回收,则依据以下步骤进行:
步骤5.1:回收航线规划模块接受跑道回收参数:跑道方向角α,着陆点经纬度坐标(LL,BL),跑道回收航线进入点SR点至窗口点WR点的距离D1To2,差分GPS高度Hs,将着陆点经纬度坐标(LL,BL),转换为平面直角坐标下的位置(XL,YL);
步骤5.2:跑道回收从正向和逆向两个方向进行,正向回收方向角α′=α,逆向回收方向角α′=α+π,可生成正向和逆向两条跑道回收航线;
步骤5.3:跑道回收航线为4个航点组成的折线,其中SR点为航线进入点,WR点为窗口点,L点为着陆点,C点为纠偏点,SR点和WR点相对跑道的高度均为h,依次生成4个航点的经纬度以及SR点和WR点的高度:
步骤5.3.1:计算SR点直角坐标位置:
将SR点直角坐标(XSR,YSR)转换成经纬度坐标(LSR,BSR),SR点高度为:HSR=Hs+h;
步骤5.3.2:计算窗口点WR点的直角坐标位置:
将WR点直角坐标(XVR,YWR)转换成经纬度坐标(LWR,BWR),WR点高度:HWR=Hs+h;
步骤5.3.3:着陆点L点的经纬度坐标为(LL,BL);
步骤5.3.4:计算C点直角坐标位置:将C点直角坐标(XC,YC)转换成经纬度坐标(LC,BC);
由此生成跑道回收航线;
步骤6:若为绳钩回收,则依据以下步骤进行:
步骤6.1:接受绳钩回收参数:撞线点H点经纬度坐标(LH,BH),绳钩回收方向角β,绳钩回收航线窗口点WC点至撞线点H点的水平距离D2ToH,差分GPS高度Hs,将撞线点经纬度坐标(LH,BH),转换为平面直角坐标下的位置(XH,YH);
步骤6.2:撞线回收从正向和逆向两个方向进行,正向回收方向角β′=β,逆向回收方向角β′=β+π,生成正向和逆向两条撞线回收航线;
步骤6.3:撞线回收航线为6个航点组成的折线,其中SC点为航线进入点,WC点为窗口点,无人机在WC与A1点之间撞线回收,若无人机没有成功撞线回收,则进入A1、A2、A3、A4点进行复飞调整,然后再进入SC点重新准备撞线回收;6个航点相对回收场地的高度均为h,依次生成6个航点的经纬度和高度;
步骤6.3.1:计算SC点直角坐标位置:
将SC点直角坐标(XSC,YSC)转换成经纬度坐标(LSC,BSC);
步骤6.3.2:计算WC点直角坐标位置:
将WC点直角坐标(XWC,YWC)转换成经纬度坐标(LWC,BWC);
步骤6.3.3:计算A1点直角坐标位置:
将A1点直角坐标(XA1,YA1)转换成经纬度坐标(LA1,BA1);
步骤6.3.4:计算A2点直角坐标位置:
将A2点直角坐标(XA2,YA2)转换成经纬度坐标(LA2,BA2);
步骤6.3.5:计算A3点直角坐标位置:
将A3点直角坐标(XA3,YA3)转换成经纬度坐标(LA3,BA3);
步骤6.3.6:计算A4点直角坐标位置:将A4点直角坐标(XA4,YA4)转换成经纬度坐标(LA4,BA4);
步骤6.3.7∶6个航点的高度均为H=Hs+h;
由此生成绳钩回收航线。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910205720.4A CN109933088B (zh) | 2019-03-18 | 2019-03-18 | 一种适用于双模回收的无人机航线自动生成方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201910205720.4A CN109933088B (zh) | 2019-03-18 | 2019-03-18 | 一种适用于双模回收的无人机航线自动生成方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN109933088A true CN109933088A (zh) | 2019-06-25 |
CN109933088B CN109933088B (zh) | 2022-03-01 |
Family
ID=66987571
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201910205720.4A Active CN109933088B (zh) | 2019-03-18 | 2019-03-18 | 一种适用于双模回收的无人机航线自动生成方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN109933088B (zh) |
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110530374A (zh) * | 2019-10-08 | 2019-12-03 | 西安爱生技术集团公司 | 一种无人机天钩回收阶段航迹偏差显示方法 |
CN111077903A (zh) * | 2019-12-12 | 2020-04-28 | 南京航空航天大学 | 一种基于窗口决策的高容错性的天钩回收方法 |
CN112631332A (zh) * | 2020-12-24 | 2021-04-09 | 中国航天空气动力技术研究院 | 无人机快速自动返航着陆方法 |
CN114049797A (zh) * | 2021-11-10 | 2022-02-15 | 中国人民解放军国防科技大学 | 一种无人机自主滑跑回收航线的自动生成方法和装置 |
Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103116358A (zh) * | 2013-01-15 | 2013-05-22 | 南京航空航天大学 | 一种空间飞行器绳索稳定收放控制方法 |
CN103529852A (zh) * | 2013-10-31 | 2014-01-22 | 中国航天空气动力技术研究院 | 一种基于双卫星接收机的无人机寻的回收导引控制方法 |
CN104503459A (zh) * | 2014-11-25 | 2015-04-08 | 深圳市鸣鑫航空科技有限公司 | 多旋翼无人机回收系统 |
CN104991565A (zh) * | 2015-06-10 | 2015-10-21 | 西安爱生技术集团公司 | 伞降固定翼无人机自主定点回收方法 |
CN107585322A (zh) * | 2017-09-06 | 2018-01-16 | 哈尔滨工业大学 | 一种线网复合机背天钩撞线式地面及舰载小型无人机回收系统及回收方法 |
CN107792373A (zh) * | 2017-11-01 | 2018-03-13 | 陶文英 | 一种飞行器空中回收无人机的方法及其系统 |
CN108255192A (zh) * | 2017-12-08 | 2018-07-06 | 中国航空工业集团公司成都飞机设计研究所 | 一种小型舰载无人机回收航路规划管理方法 |
US20180224868A1 (en) * | 2012-10-24 | 2018-08-09 | Aurora Flight Sciences Corporation | System and Methods for Automatically Landing Aircraft |
CN109144096A (zh) * | 2018-08-15 | 2019-01-04 | 东汉太阳能无人机技术有限公司 | 一种无人机着陆的控制方法及无人机 |
CN109358645A (zh) * | 2018-11-19 | 2019-02-19 | 南京航空航天大学 | 一种小型舰载无人机自适应绳钩回收制导航路及制导方法 |
-
2019
- 2019-03-18 CN CN201910205720.4A patent/CN109933088B/zh active Active
Patent Citations (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
US20180224868A1 (en) * | 2012-10-24 | 2018-08-09 | Aurora Flight Sciences Corporation | System and Methods for Automatically Landing Aircraft |
CN103116358A (zh) * | 2013-01-15 | 2013-05-22 | 南京航空航天大学 | 一种空间飞行器绳索稳定收放控制方法 |
CN103529852A (zh) * | 2013-10-31 | 2014-01-22 | 中国航天空气动力技术研究院 | 一种基于双卫星接收机的无人机寻的回收导引控制方法 |
CN104503459A (zh) * | 2014-11-25 | 2015-04-08 | 深圳市鸣鑫航空科技有限公司 | 多旋翼无人机回收系统 |
CN104991565A (zh) * | 2015-06-10 | 2015-10-21 | 西安爱生技术集团公司 | 伞降固定翼无人机自主定点回收方法 |
CN107585322A (zh) * | 2017-09-06 | 2018-01-16 | 哈尔滨工业大学 | 一种线网复合机背天钩撞线式地面及舰载小型无人机回收系统及回收方法 |
CN107792373A (zh) * | 2017-11-01 | 2018-03-13 | 陶文英 | 一种飞行器空中回收无人机的方法及其系统 |
CN108255192A (zh) * | 2017-12-08 | 2018-07-06 | 中国航空工业集团公司成都飞机设计研究所 | 一种小型舰载无人机回收航路规划管理方法 |
CN109144096A (zh) * | 2018-08-15 | 2019-01-04 | 东汉太阳能无人机技术有限公司 | 一种无人机着陆的控制方法及无人机 |
CN109358645A (zh) * | 2018-11-19 | 2019-02-19 | 南京航空航天大学 | 一种小型舰载无人机自适应绳钩回收制导航路及制导方法 |
Non-Patent Citations (3)
Title |
---|
曹浩楠等: "固定翼无人机发射与回收技术发展综述", 《科技创新导报》 * |
王宏新等: "无人机回收技术及其发展", 《无人机》 * |
王帝等: "用于无人机精确着舰的翼伞归航控制方法", 《航天返回与遥感》 * |
Cited By (8)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN110530374A (zh) * | 2019-10-08 | 2019-12-03 | 西安爱生技术集团公司 | 一种无人机天钩回收阶段航迹偏差显示方法 |
CN110530374B (zh) * | 2019-10-08 | 2023-06-23 | 西安爱生技术集团公司 | 一种无人机天钩回收阶段航迹偏差显示方法 |
CN111077903A (zh) * | 2019-12-12 | 2020-04-28 | 南京航空航天大学 | 一种基于窗口决策的高容错性的天钩回收方法 |
CN111077903B (zh) * | 2019-12-12 | 2021-11-16 | 南京航空航天大学 | 一种基于窗口决策的高容错性的天钩回收方法 |
CN112631332A (zh) * | 2020-12-24 | 2021-04-09 | 中国航天空气动力技术研究院 | 无人机快速自动返航着陆方法 |
CN112631332B (zh) * | 2020-12-24 | 2022-10-18 | 中国航天空气动力技术研究院 | 无人机快速自动返航着陆方法 |
CN114049797A (zh) * | 2021-11-10 | 2022-02-15 | 中国人民解放军国防科技大学 | 一种无人机自主滑跑回收航线的自动生成方法和装置 |
CN114049797B (zh) * | 2021-11-10 | 2022-08-02 | 中国人民解放军国防科技大学 | 一种无人机自主滑跑回收航线的自动生成方法和装置 |
Also Published As
Publication number | Publication date |
---|---|
CN109933088B (zh) | 2022-03-01 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109933088A (zh) | 一种适用于双模回收的无人机航线自动生成方法 | |
US11940795B2 (en) | Performing 3D reconstruction via an unmanned aerial vehicle | |
CN105549619A (zh) | 一种用于无人机续航能力的多起降点航线规划方法 | |
EP3550394B1 (en) | Efficient flight profiles with multiple rta constraints | |
CN105404308A (zh) | 一种翼伞无人机飞行控制器 | |
CN106909167A (zh) | 一种多机多站联合立体任务系统及方法 | |
CN106441286A (zh) | 基于bim技术的无人机隧道巡检系统 | |
CN110530374B (zh) | 一种无人机天钩回收阶段航迹偏差显示方法 | |
CN106927059A (zh) | 一种基于单目视觉的无人机降落方法及装置 | |
CN105302158B (zh) | 基于Dubins路径的无人机空中加油最短时间会合方法 | |
CN108694864B (zh) | 一种复杂低空飞行多机冲突探测与解脱方法及系统 | |
CN111045454A (zh) | 一种基于仿生自主导航的无人机自驾仪 | |
CN105843246A (zh) | 无人机跟踪方法、系统及无人机 | |
CN110045741A (zh) | 安全引导无人飞行器下滑着陆的组合导航系统 | |
CN105513434A (zh) | 无人机飞行管制系统及其管制方法 | |
CN105953800A (zh) | 一种无人飞行器航迹规划栅格空间划分方法 | |
CN110196454A (zh) | 基于无人机的地质勘测集成系统 | |
CN106094877A (zh) | 一种无人机着陆导航系统及控制方法 | |
CN108627864A (zh) | 基于汽车钥匙的定位方法及系统、无人驾驶汽车系统 | |
CN108445912A (zh) | 一种植保无人机飞行控制系统 | |
CN108710383A (zh) | 一种基于航点规划与跟踪的四旋翼飞行器自主降落控制方法 | |
CN105628045A (zh) | 一种无人机跟拍路径规划与跟踪方法 | |
CN113885580A (zh) | 基于无人机实现自动化巡检风机的路径规划方法及系统 | |
CN107045804A (zh) | 无人机的实时分配和管控系统及方法 | |
CN109211200A (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 |