[发明专利]一种农用植保无人机喷施过程中多障碍、小障碍下的避障方法及无人机有效
申请号: | 201611153715.6 | 申请日: | 2016-12-14 |
公开(公告)号: | CN106598070B | 公开(公告)日: | 2019-11-22 |
发明(设计)人: | 张喜海;宋伟先;范成国;许绥佳;乔岳;杜佳丽;刘东;房俊龙;王梓璇 | 申请(专利权)人: | 东北农业大学 |
主分类号: | G05D1/10 | 分类号: | G05D1/10;B64D1/18 |
代理公司: | 23109 哈尔滨市松花江专利商标事务所 | 代理人: | 杨立超<国际申请>=<国际公布>=<进入 |
地址: | 150030 黑龙*** | 国省代码: | 黑龙;23 |
权利要求书: | 查看更多 | 说明书: | 查看更多 |
摘要: | |||
搜索关键词: | 一种 农用 植保 无人机 喷施 过程 障碍 方法 | ||
1.一种农用植保无人机喷施过程中多障碍下的避障方法,其特征在于,包括如下步骤:
步骤1)将飞行路径的起点和终点连接,形成一条用于表示原飞行路线的直线段;
步骤2)判断所述直线段是否与障碍圆相交,若不相交,则按原路线直线飞行,若相交,则执行步骤3);所述障碍圆是用于表示障碍物位置和大小特征的模型;将与所述直线段相交的障碍圆称为目标障碍圆;
步骤3)生成复数个与所述直线段与所述目标障碍圆同时相切的最小转弯圆;所述最小转弯圆的半径为无人机的最小转弯半径;
步骤4)根据所述直线段、所述目标障碍圆以及所述最小转弯圆确定复数个可选的飞行路径并计算路径的长度以及与所述可选的飞行路径对应的重喷漏喷面积,并将数据进行归一化处理;
所述步骤4)中,每条可选的飞行路径的长度的计算公式为:
其中N为必须躲避的障碍总数,N1 是障碍圆与最小转弯圆异侧的障碍圆个数,N2 是障碍圆与最小转弯圆同侧的情况,且满足N1+N2=N;b为所述直线段的长度;Ri为第i个障碍圆的半径;Rz为无人机的最小转弯半径;Li为第i个障碍圆的圆心到所述直线段的垂线段距离;所述第i个障碍圆半径Ri满足公式Ri=Rd+R1,其中Rd为第i个障碍圆的中心到最边缘的距离,Rl为无人机需要与障碍物保持的安全距离;
步骤4)中与每条飞行路径对应的重喷漏喷面积的计算公式为:
步骤5)将所述复数个可选路径作为初始种群,计算出适应值的大小;
步骤6)使用遗传算法的选择、交叉、变异操作,当满足迭代次数或者满足预定的适应值大小条件时,输出最佳的搜索路径;
2.根据权利要求1所述的方法,其中,所述遗传算法的染色体基因对应于顶点,所述顶点的确定方法为:
过每个障碍圆的圆心,作所述直线段的垂线,所述垂线与所述障碍圆形成2个交点;将所有所述交点与所述飞行路径的起点与终点的集合作为顶点的集合;
设K为障碍圆的个数,则所述顶点集中有2+2K个顶点;
所述染色体编码从第1位到第2k+2位分别表示选择原飞行路径的起点、第1个障碍圆左侧的路径、选择第1个障碍圆右侧的路径、选择第2个障碍圆左侧的路径……选择第k个圆的右侧路径、原飞行路径的终点。
3.根据权利要求1所述的方法,其特征在于,所述遗传算法的适宜度函数为:
其中Fitness(i)为第i条路径的适宜度,D(xi)和S(xi)分表代表路径长度归一化后的数据以及重喷漏喷面积归一化后的数据;β1、β2分别代表路径长度和重喷漏喷面积的权重;
路径长度和重喷漏喷面积采用的数据归一化函数为:
其中x为待处理的数据,x*为经过归一化处理后的数据。
该专利技术资料仅供研究查看技术是否侵权等信息,商用须获得专利权人授权。该专利全部权利属于东北农业大学,未经东北农业大学许可,擅自商用是侵权行为。如果您想购买此专利、获得商业授权和技术合作,请联系【客服】
本文链接:http://www.vipzhuanli.com/pat/books/201611153715.6/1.html,转载请声明来源钻瓜专利网。