一种适用于光电载荷无人机系统的任务航线自动规划方法技术方案

本发明专利技术提供了一种适用于光电载荷无人机系统的任务航线自动规划方法，根据给定的目标区域信息，自动生成任务航线引导无人机执行光电侦察任务，若侦察目标点，则进入定点模式的航线，若侦察目标区域，则进入弓形模式的航线。本发明专利技术提出一种适用于光电载荷无人机系统的任务航线规划方法，与之前的手动航线规划方式相比，利用了已知的目标区域和目标点信息，计算出航点信息，提高了规划航线的精确度；同时本发明专利技术在给定了目标区域和目标点的参数后自动生成任务规划航线，免除了操作员在图上作业的不便，极大地提高了光电载荷任务规划的效率。

【技术实现步骤摘要】
一种适用于光电载荷无人机系统的任务航线自动规划方法
本专利技术涉及无人机任务规划领域，更具体地说，是指一种适用于无人机系统的任务航线规划方法。
技术介绍
无人机的主要任务之一就是侦察和监视，侦察无人机快速发展成为了无人机机的主力军，需要根据侦察的目标和范围进行航线规划，以便使机载侦察设备采集到需要的侦察信息，从而为其它武器协同作战提供保障。最基本的航线规划方法是通过无人机系统地面控制站软件在数字地图上设置航程点形成航线，然后将规划的航线信息通过无线电数据链上传至飞机，再由机载导航系统控制飞机沿航线飞行。这种人工手动规划任务航线，费时费力且精确度不高，难以适应飞行时快速任务航线规划的需要。目前未见相关的光电载荷无人机系统任务航线自动规划方法。
技术实现思路
为了克服现有技术的不足，本专利技术提供一种适用于光电载荷无人机系统的任务航线自动规划方法，根据给定的目标区域信息，自动生成任务航线引导无人机执行光电侦察任务。本专利技术解决其技术问题所采用的技术方案的步骤如下：步骤1：根据上级指挥员下达的光电载荷无人机执行的侦察任务，确定任务对象是侦察目标点还是侦察目标区域，选择执行的任务模式，若侦察目标点，则进入定点模式规划流程，进入步骤2；若侦察目标区域，则进入弓形模式规划流程，即进入步骤3；步骤2：若为定点模式，则依据以下步骤进行：步骤2.1：接受侦察任务目标参数输入：驶入目标区域A点经纬度坐标(LA，BA)，驶出目标区域B点经纬度坐标(LB，BB)，侦察目标点T点经纬度(LT，BT)，海拔高度为HT，无人机在执行侦察任务时相对目标区域的高度为h，无人机围绕目标点作圆周飞行时的盘旋圆的半径为RT，目标区域为长方形，由上级指挥控制系统下传目标区域的长、宽、以及中心点参数；步骤2.2：将A点经纬度坐标(LA，BA)转换为平面直角坐标下的位置(XA，YA)，将B点经纬度坐标(LB，BB)转换为平面直角坐标下的位置(XB，YB)，将侦察目标点T点经纬度(LT，BT)，转换为平面直角坐标下的位置(XT，YT)，根据三点的位置计算出A点至T点的距离DAT以及B点至T点的距离DBT：步骤2.3：通过A点作盘旋圆的切线，切点为S点，通过B点作盘旋圆的切线，切点为E点，计算A点至S点的距离DAS以及B点至E点的距离DBE：步骤2.4：A点与目标点T点连线的方向角为α，线段AT与AS形成的夹角为Δα，同样B点与目标点T点连线的方向角为β，线段BT与BE形成的夹角为Δβ，则：步骤2.5：A点与S点连线的方向角为α，B点与E点连线的方向角为β′；若α-β＞0，则若α-β＜0，则步骤2.6：根据方向角α′和β′，A点位置坐标(XA，YA)和B点位置坐标(XB，YB)，距离DAS和距离DBE，计算S点和E点的位置(Xs，Ys)和(XE，YE)：再利用坐标转换将S点和E点的直角坐标(Xs，Ys)和(XE，YE)转换为经纬度(Ls，Bs)和(LE，BE)；步骤2.7：定点模式的任务航线航点依次为：A点驶入点：坐标(LA，BA，HT+h)；S点开始侦察点：坐标(Ls，Bs，HT+h)，指令为开始侦察，盘旋半径为RT，盘旋圆心为(LT，BT)，盘旋周期为n，经过n次盘旋后进入E点结束侦察；E点结束侦察点：坐标(LE，BE，HT+h)，指令为结束侦察；B点驶出点：坐标(LB，BB，HT+h)；步骤3：若为弓形模式(无人机载侦察时的任务航线为弓形)，则依据以下步骤进行：步骤3.1：接受侦察任务参数输入：侦察区为宽度DW、高度DH的长方形，长方形侦察区的中心点C点的经纬度坐标(LC，BC)，侦察区域倾斜角为θ，区域海拔高为HS，无人机在执行任务时相对于侦察区域的高度为h，弓形航线的间距为d；步骤3.2：假设区域倾斜角为0度，将区域中心点C点的经纬度坐标(LC，BC)，转换为平面直角坐标下的位置(XC，YC)，计算区域顶点0点(将该点作为弓形航线的起始点)的位置：步骤3.3：以1、2、3、4四个点为一个循环，计算整个区域的循环次为向下取整函数，即示不大于X的最大整数)，则整个区域的弓形航线航点数为N＝4n+1，对i从0开始进行循环，i＜n，j＝4n，计算除起始点0点以外的航点位置：步骤3.4：利用给定角度的坐标变换计算侦察区域倾斜角为θ时的弓形航线航点位置，K为航点序号(K从0开始)，*代表侦察区域旋转倾斜角θ之后的弓形航线航点：将所有航点直角坐标位置转化为经纬度坐标(Lk，Bk)，所有弓形航线航点高度均为H＝Hs+h。本专利技术的有益效果在于由于提出一种适用于光电载荷无人机系统的任务航线规划方法，与之前的手动航线规划方式相比，利用了已知的目标区域和目标点信息，计算出航点信息，提高了规划航线的精确度；同时本专利技术在给定了目标区域和目标点的参数后自动生成任务规划航线，免除了操作员在图上作业的不便，极大地提高了光电载荷任务规划的效率。附图说明图1为本专利技术定点模式侦察目标信息示意图。图2为本专利技术定点模式开始侦察点和结束侦察点计算关系示意图。图3为本专利技术弓形模式侦察区域信息示意图。图4为本专利技术弓形模式规划航线示意图。图5为本专利技术光电载荷无人机航线规划流程图。其中，RT为盘旋圆的半径，A为驶入目标区域点，B为驶出目标区域点，T为侦察目标点，DAT为A点至T点的距离，DBT为B点至T点的距离，DAS为A点至S点的距离，DBE为B点至E点的距离，α为A点与目标点T点连线的方向角，AT与AS形成的夹角为Δα，B点与目标点T点连线的方向角为β，线段BT与BE形成的夹角为Δβ，A点与S点连线的方向角为α′，B点与E点连线的方向角为β′，DW为侦察区宽度，DH为侦察区的高度，C点为侦察区的中心点，侦察区域倾斜角为θ。具体实施方式下面结合附图和实施例对本专利技术进一步说明。步骤1：根据上级指挥员下达的光电载荷无人机执行的侦察任务，确定任务对象是侦察目标点还是侦察目标区域，选择执行的任务模式，若侦察目标点，则进入定点模式规划流程,，进入步骤2；若侦察目标区域，则进入弓形模式规划流程，即进入步骤3；步骤2：若为定点模式，则依据以下步骤进行：步骤2.1：接受侦察任务目标参数输入：驶入目标区域A点经纬度坐标(LA，BA)，驶出目标区域B点经纬度坐标(LB，BB)，侦察目标点T点经纬度(LT，BT)，海拔高度为HT，无人机在执行侦察任务时相对目标区域的高度为h，无人机围绕目标点作圆周飞行时的盘旋圆的半径为RT，如附图1所示，目标区域为长方形，由上级指挥控制系统下传目标区域的长、宽、以及中心点参数；步骤2.2：将A点经纬度坐标(LA，BA)转换为平面直角坐标下的位置(XA，YA)，将B点经纬度坐标(LB，BB)转换为平面直角坐标下的位置(XB，YB)，将侦察目标点T点经纬度(LT，BT)，转换为平面直角坐标下的位置(XT，YT)，根据三点的位置计算出A点至T点的距离DAT以及B点至T点的距离DBT：步骤2.3：通过A点作盘旋圆的切线，切点为S点，通过B点作盘旋圆的切线，切点为E点，如图2所示；计算A点至S点的距离DAS以及B点至E点的距离DBE：步骤2.4：如图2所示，A点与目标点T点连线的方向角为α，线段AT与AS形成的夹角为Δα，同样B点与目标点T点连线的方向角为β，线段BT与BE形成的夹角为Δβ本文档来自技高网...

【技术保护点】
1.一种适用于光电载荷无人机系统的任务航线自动规划方法，其特征在于包括下述步骤：步骤1：根据上级指挥员下达的光电载荷无人机执行的侦察任务，确定任务对象是侦察目标点还是侦察目标区域，选择执行的任务模式，若侦察目标点，则进入定点模式规划流程，进入步骤2；若侦察目标区域，则进入弓形模式规划流程，即进入步骤3；步骤2：若为定点模式，则依据以下步骤进行：步骤2.1：接受侦察任务目标参数输入：驶入目标区域A点经纬度坐标(LA，BA)，驶出目标区域B点经纬度坐标(LB，BB)，侦察目标点T点经纬度(LT，BT)，海拔高度为HT，无人机在执行侦察任务时相对目标区域的高度为h，无人机围绕目标点作圆周飞行时的盘旋圆的半径为RT，目标区域为长方形，由上级指挥控制系统下传目标区域的长、宽、以及中心点参数；步骤2.2：将A点经纬度坐标(LA，BA)转换为平面直角坐标下的位置(XA，YA)，将B点经纬度坐标(LB，BB)转换为平面直角坐标下的位置(XB，YB)，将侦察目标点T点经纬度(LT，BT)，转换为平面直角坐标下的位置(XT，YT)，根据三点的位置计算出A点至T点的距离DAT以及B点至T点的距离DBT：

【技术特征摘要】
1.一种适用于光电载荷无人机系统的任务航线自动规划方法，其特征在于包括下述步骤：步骤1：根据上级指挥员下达的光电载荷无人机执行的侦察任务，确定任务对象是侦察目标点还是侦察目标区域，选择执行的任务模式，若侦察目标点，则进入定点模式规划流程，进入步骤2；若侦察目标区域，则进入弓形模式规划流程，即进入步骤3；步骤2：若为定点模式，则依据以下步骤进行：步骤2.1：接受侦察任务目标参数输入：驶入目标区域A点经纬度坐标(LA，BA)，驶出目标区域B点经纬度坐标(LB，BB)，侦察目标点T点经纬度(LT，BT)，海拔高度为HT，无人机在执行侦察任务时相对目标区域的高度为h，无人机围绕目标点作圆周飞行时的盘旋圆的半径为RT，目标区域为长方形，由上级指挥控制系统下传目标区域的长、宽、以及中心点参数；步骤2.2：将A点经纬度坐标(LA，BA)转换为平面直角坐标下的位置(XA，YA)，将B点经纬度坐标(LB，BB)转换为平面直角坐标下的位置(XB，YB)，将侦察目标点T点经纬度(LT，BT)，转换为平面直角坐标下的位置(XT，YT)，根据三点的位置计算出A点至T点的距离DAT以及B点至T点的距离DBT：步骤2.3：通过A点作盘旋圆的切线，切点为S点，通过B点作盘旋圆的切线，切点为E点，计算A点至S点的距离DAS以及B点至E点的距离DBE：步骤2.4：A点与目标点T点连线的方向角为α，线段AT与AS形成的夹角为Δα，同样B点与目标点T点连线的方向角为β，线段BT与BE形成的夹角为Δβ，则：步骤2.5：A点与S点连线的方向角为α′，B点与E点连线的方向角为β′；若α-β＞0，则若α-β＜0，则步骤2.6：根据方向角α′和β′，A点位置坐标(XA，YA)和B点位置坐标(XB，Y...

【专利技术属性】
技术研发人员：刘洋，贾伟，肖佳伟，田雪涛，贺若飞，张波，
申请(专利权)人：西安爱生技术集团公司，西北工业大学，
类型：发明
国别省市：陕西,61