无人机自动航迹生成方法技术

技术编号:14663215 阅读:186 留言:0更新日期:2017-02-17 10:36
本发明专利技术涉及无人机技术领域,具体涉及一种无人机自动航迹生成方法,包括:对待标定区域的外轮廓进行采样;对采样点集进行最小外接凸多边形的计算,并通过经纬度坐标与平面投影坐标的转换,获得待标定区域的坐标及面积;根据田块和障碍物的坐标及面积获得作业区域,求取所述作业区域的最短作业路径;当无人机在所述作业区域作业时,判断无人机在下一个航点是否能安全到达至少一个安全起降点,若是,则继续作业,否则,在当前航点返航,本发明专利技术能够精确标定田块、障碍物和安全起降点的坐标及面积,并自动生成最短作业路径,使得无人机在按照最短作业路径自动作业的情况下自主避障,且能自动选择最近的安全起降点进行自主返航。

【技术实现步骤摘要】

本专利技术涉及无人机
,具体涉及一种无人机自动航迹生成方法
技术介绍
当前无人机喷施物料作业大多数采用手动作业,其作业精度难以保证,由于缺乏喷施无聊远程检测以及电池余量远程检测的手段,飞手在作业的过程中往往采用估计的方法估算物料及电池的余量,这种作业方式易造成电池的浪费以及物料的漏喷。目前已存在部分具有自主导航功能的农用无人机,其航线规划方法为在卫星地图上标定田块边界并进行等距航线规划,考虑到人工打点的精度、卫星遥感影像较低的时域分辨率以及GPS接收机与国内地图的投影参考椭球体的差异,这种方法并不能精准地获取田块边界;与此同时,该方法并不能准确地获取田间的障碍物以及home点坐标,市面上常见的无人机利用起飞点作为home点,当无人机出现异常情况,如电池电量过低、药箱余量不足的情况下自动返航。然而由于农村空域环境复杂,常有电线杆、高压线、围栏等障碍物,在缺乏切实可靠的自主避障机制的情况下,不能够保证无人机能够安全地返航。
技术实现思路
本专利技术的目的在于提出一种无人机自动航迹生成方法,能够精确标定田块、障碍物和安全起降点的坐标及面积,并自动生成最短作业路径,使得无人机在按照最短作业路径自动作业的情况下自主避障,且能自动选择最近的安全起降点进行自主返航。为达此目的,本专利技术采用以下技术方案:作为本专利技术的一个方面,提供的一种无人机自动航迹生成方法,包括:对待标定区域的外轮廓进行采样,获得待标定区域的外轮廓的采样点集,所述待标定区域包括田块、障碍物及安全起降点;对所述采样点集进行最小外接凸多边形的计算,并通过经纬度坐标与平面投影坐标的转换,获得待标定区域的坐标及面积;根据田块和障碍物的坐标及面积获得作业区域,对所述作业区域进行网格化,并求取所述作业区域的最短作业路径,所述最短作业路径由若干个航点组成;当无人机在所述作业区域作业时,计算当前航点及下一个航点到所有安全起降点的距离,判断无人机在下一个航点是否能安全到达至少一个安全起降点,若是,则继续作业,否则,在当前航点返航。可选地,所述对待标定区域的外轮廓进行采样,获得待标定区域的外轮廓的采样点集包括:在无人机上安装GPS移动站,在地面上建立GPS基站;将无人机静置于一固定点,通过GPS基站对待标定区域的外轮廓进行采样,并通过差分GPS技术获得采样点的经纬度坐标。可选地,对所述采样点集进行最小外接凸多边形的计算,并通过经纬度坐标与平面投影坐标的转换,获得待标定区域的坐标及面积包括:令所述采样点集为P(lon,lat),包含的最小面积单连通域为C,最小外接凸多边形的顶点集合为B,其中,lon、lat分别表示WGS84参考椭球体下的经度及纬度坐标;通过Karney快速坐标转换算法进行经纬度坐标与平面投影坐标的转换,公式如下:P′i(x,y)=K(Pi(lon,lat))Pi(lon,lat)=K-1(P′i(x,y))其中,K表示经纬度坐标转换至平面坐标函数;K-1表示平面坐标转换至经纬度坐标函数;x、y分别表示对应投影条带的平面坐标;i∈Card(P),i∈N+;则待标定区域的面积S为:其中,Card(B′)表示B′集合中的元素数目,可选地,根据田块和障碍物的坐标及面积获得作业区域具体为:令田块的连通域边界点集为CF,带有冗余余量的障碍物连通域为则作业田块面积Stotal为:则除去田块中障碍物的作业区域R表示为:可选地,对所述作业区域进行网格化,并求取所述作业区域的最短作业路径具体为:令无人机作业时飞行高度为h时的喷雾幅宽为w,喷雾纵向宽度为l,则将作业区域R离散为宽度为w,长度为l的单连通区域Ri;以任意Ri为起始子区域,并对其相邻子区域Rj进行检测,若Ri∪Rj单连通域,则有Ri=Ri∪Rj,持续迭代当Rj=φ或Ri∪Rj为多连通域时则停止迭代;通过计算不同组合的下合并后的单连通域的规划航迹长度,取最短的组合作为最短作业路径。可选地,所述计算当前航点及下一个航点到所有安全起降点的距离具体为:令当前航点为P0,该航点到所有安全起降点的距离为DH;当无人机与安全起降点不存在障碍物时,有其中为第i个安全起降点的中点;当无人机与安全起降点存在障碍物时,根据凸多边形的定义,在E″i一侧存在一点E″ij,有:若E″ijDH∩E″i=E″ij,则反之则寻找E″i靠近一侧继续迭代,直至则有:通过比较该障碍物左右两侧求取的DH则可判定两侧路程差异,从而判定最优返航航线。可选地,所述判断无人机在下一个航点是否能安全到达至少一个安全起降点包括:自动采集无人机的剩余电量,根据所述剩余电量及所述航点到所有安全起降点的距离判断无人机在下一个航点是否能安全到达至少一个安全起降点;或自动采集无人机的剩余物料,根据所述剩余物料及所述所述作业区域内单连通区域Ri的面积判断无人机能否持续作业到下一个航点。可选地,所述田块内部设置有若干个喷头,所述若干个喷头平均分配到作业区域R的单连通区域Ri中;当所述单连通区域Ri位于作业区域R的边界时,打开所述单连通区域Ri内的喷头。本专利技术的有益效果为:一种无人机自动航迹生成方法,包括:对待标定区域的外轮廓进行采样,获得待标定区域的外轮廓的采样点集,所述待标定区域包括田块、障碍物及安全起降点;对所述采样点集进行最小外接凸多边形的计算,并通过经纬度坐标与平面投影坐标的转换,获得待标定区域的坐标及面积;根据田块和障碍物的坐标及面积获得作业区域,对所述作业区域进行网格化,并求取所述作业区域的最短作业路径,所述最短作业路径由若干个航点组成;当无人机在所述作业区域作业时,计算当前航点及下一个航点到所有安全起降点的距离,判断无人机在下一个航点是否能安全到达至少一个安全起降点,若是,则继续作业,否则,在当前航点返航,能够精确标定田块、障碍物和安全起降点的坐标及面积,并自动生成最短作业路径,使得无人机在按照最短作业路径自动作业的情况下自主避障,且能自动选择最近的安全起降点进行自主返航。附图说明图1是本专利技术实施例提供的一种无人机自动航迹生成方法流程图;图2是本专利技术实施例提供的一种无人机最优返航路线计算示意图;图3是本专利技术实施例提供的一种无人机自动航迹规划示意图。具体实施方式下面结合图1-图3并通过具体实施方式来进一步说明本专利技术的技术方案。图1是本实施例提供的一种无人机自动航迹生成方法流程图。一种无人机自动航迹生成方法,包括:S10、对待标定区域的外轮廓进行采样,获得待标定区域的外轮廓的采样点集,所述待标定区域包括田块、障碍物及安全起降点;S20、对所述采样点集进行最小外接凸多边形的计算,并通过经纬度坐标与平面投影坐标的转换,获得待标定区域的坐标及面积;S30、根据田块和障碍物的坐标及面积获得作业区域;S40、对所述作业区域进行网格化,并求取所述作业区域的最短作业路径,所述最短作业路径由若干个航点组成;S50、当无人机在所述作业区域作业时,计算当前航点及下一个航点到所有安全起降点的距离;S60、判断无人机在下一个航点是否能安全到达至少一个安全起降点,若是,进入步骤S70、继续作业,否则,进入步骤S80、在当前航点返航。在本实施例中,能够精确标定田块、障碍物和安全起降点的坐标及面积,并自动生成最短作业路径,使得无人机在按照最短作业路径自动作业的情况下自主避障,且能自动选择本文档来自技高网...
无人机自动航迹生成方法

【技术保护点】
一种无人机自动航迹生成方法,其特征在于,包括:对待标定区域的外轮廓进行采样,获得待标定区域的外轮廓的采样点集,所述待标定区域包括田块、障碍物及安全起降点;对所述采样点集进行最小外接凸多边形的计算,并通过经纬度坐标与平面投影坐标的转换,获得待标定区域的坐标及面积;根据田块和障碍物的坐标及面积获得作业区域,对所述作业区域进行网格化,并求取所述作业区域的最短作业路径,所述最短作业路径由若干个航点组成;当无人机在所述作业区域作业时,计算当前航点及下一个航点到所有安全起降点的距离,判断无人机在下一个航点是否能安全到达至少一个安全起降点,若是,则继续作业,否则,在当前航点返航。

【技术特征摘要】
1.一种无人机自动航迹生成方法,其特征在于,包括:对待标定区域的外轮廓进行采样,获得待标定区域的外轮廓的采样点集,所述待标定区域包括田块、障碍物及安全起降点;对所述采样点集进行最小外接凸多边形的计算,并通过经纬度坐标与平面投影坐标的转换,获得待标定区域的坐标及面积;根据田块和障碍物的坐标及面积获得作业区域,对所述作业区域进行网格化,并求取所述作业区域的最短作业路径,所述最短作业路径由若干个航点组成;当无人机在所述作业区域作业时,计算当前航点及下一个航点到所有安全起降点的距离,判断无人机在下一个航点是否能安全到达至少一个安全起降点,若是,则继续作业,否则,在当前航点返航。2.根据权利要求1所述的无人机自动航迹生成方法,其特征在于,所述对待标定区域的外轮廓进行采样,获得待标定区域的外轮廓的采样点集包括:在无人机上安装GPS移动站,在地面上建立GPS基站;将无人机静置于一固定点,通过GPS基站对待标定区域的外轮廓进行采样,并通过差分GPS技术获得采样点的经纬度坐标。3.根据权利要求2所述的无人机自动航迹生成方法,其特征在于,对所述采样点集进行最小外接凸多边形的计算,并通过经纬度坐标与平面投影坐标的转换,获得待标定区域的坐标及面积包括:令所述采样点集为P(lon,lat),包含的最小面积单连通域为C,最小外接凸多边形的顶点集合为B,其中,lon、lat分别表示WGS84参考椭球体下的经度及纬度坐标;通过Karney快速坐标转换算法进行经纬度坐标与平面投影坐标的转换,公式如下:Pi′i(x,y)=K(Pi(lon,lat))Pi(lon,lat)=K-1(P′i(x,y))其中,K表示经纬度坐标转换至平面坐标函数;K-1表示平面坐标转换至经纬度坐标函数;x、y分别表示对应投影条带的平面坐标;i∈Card(P),i∈N+;则待标定区域的面积S为:S=12Σi=1Card(B′)xiyi+1-xi+1yi]]>其中,Card(B′)表示B′集合中的元素数目,4.根据权利要求3所述的无人机自动航迹生成方法,其特征在于,根据田块和障碍物的坐标及面积获得作业区域具体为:令田块的连通域边界点集为CF,带有冗余余量的障碍物连通域为则作业田块面积Stotal为:Stotal=SF-Σi=1mSCF∩...

【专利技术属性】
技术研发人员:何明昊付维
申请(专利权)人:深圳高科新农技术有限公司
类型:发明
国别省市:广东;44

网友询问留言 已有0条评论
  • 还没有人留言评论。发表了对其他浏览者有用的留言会获得科技券。

1