CN113703488A - 基于改进蚁群算法的多架次作业植保无人机路径规划方法 - Google Patents
基于改进蚁群算法的多架次作业植保无人机路径规划方法 Download PDFInfo
- Publication number
- CN113703488A CN113703488A CN202111122205.3A CN202111122205A CN113703488A CN 113703488 A CN113703488 A CN 113703488A CN 202111122205 A CN202111122205 A CN 202111122205A CN 113703488 A CN113703488 A CN 113703488A
- Authority
- CN
- China
- Prior art keywords
- path
- unmanned aerial
- aerial vehicle
- point
- plant protection
- 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.)
- Withdrawn
Links
- 238000000034 method Methods 0.000 title claims abstract description 18
- 238000012163 sequencing technique Methods 0.000 claims abstract description 9
- 239000003016 pheromone Substances 0.000 claims description 45
- 241000257303 Hymenoptera Species 0.000 claims description 13
- 230000007704 transition Effects 0.000 claims description 13
- 238000005457 optimization Methods 0.000 claims description 7
- 238000012546 transfer Methods 0.000 claims description 6
- 239000011159 matrix material Substances 0.000 claims description 2
- 238000010586 diagram Methods 0.000 description 6
- 238000005507 spraying Methods 0.000 description 4
- 230000001788 irregular Effects 0.000 description 2
- 238000012986 modification Methods 0.000 description 2
- 230000004048 modification Effects 0.000 description 2
- 238000006467 substitution reaction Methods 0.000 description 2
- 201000004569 Blindness Diseases 0.000 description 1
- 241000254158 Lampyridae Species 0.000 description 1
- 230000008033 biological extinction Effects 0.000 description 1
- 238000002474 experimental method Methods 0.000 description 1
- 230000019637 foraging behavior Effects 0.000 description 1
- 239000000463 material Substances 0.000 description 1
- 238000012544 monitoring process Methods 0.000 description 1
- QVRVXSZKCXFBTE-UHFFFAOYSA-N n-[4-(6,7-dimethoxy-3,4-dihydro-1h-isoquinolin-2-yl)butyl]-2-(2-fluoroethoxy)-5-methylbenzamide Chemical compound C1C=2C=C(OC)C(OC)=CC=2CCN1CCCCNC(=O)C1=CC(C)=CC=C1OCCF QVRVXSZKCXFBTE-UHFFFAOYSA-N 0.000 description 1
- 239000011664 nicotinic acid Substances 0.000 description 1
- 239000002245 particle Substances 0.000 description 1
- 238000012545 processing Methods 0.000 description 1
- 230000001105 regulatory effect Effects 0.000 description 1
- 238000004088 simulation Methods 0.000 description 1
- 238000012360 testing method Methods 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
- G05D1/106—Change initiated in response to external conditions, e.g. avoidance of elevated terrain or of no-fly zones
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)
- Management, Administration, Business Operations System, And Electronic Commerce (AREA)
Abstract
Description
技术领域
本发明涉及路径规划领域,具体涉及一种基于改进蚁群算法的多架次作业植保无人机路径规划方法。
背景技术
多旋翼植保无人机与传统植保机械相比具有效率高、成本低、地形适应性强、操作灵活等优点,得到广泛应用。传统的路径规划方法有人工势场法、Dijstra算法等。随着障碍物增多,问题规模复杂度不断增加,传统算法存在一定局限性,因此一些仿生智能优化算法应运而生,如蚁群算法、粒子群算法、萤火虫算法等。
植保无人机再进行喷施作业时作业区域面积较大,需多次更换电池和补给物料才能完成一次作业任务,一般植保无人机喷施的路线为牛耕往复法,其路线图为图4所示。植保无人机在喷施作业中很有可能电池的续航时间不足,这无可避免的会涉及到植保无人机的返航补给的问题。
蚁群算法是一种模拟蚂蚁觅食行为的模拟优化算法,适用于处理旅行商问题,能够以转移路径最短为目标,得出较优的节点排序。其基本思路为:蚁群分批次出发,每只蚂蚁选择一条遍历各节点的路线,并在路线上留下信息素,总长度较短的路线上信息素较多,后来的蚂蚁会选择信息素浓度较高路径,随着批次增多,总长度较短的路线上信息素不断积累,最终,蚁群会集中到信息素最多的路线上。
考虑植保无人机续航时间的作业路径的排序问题与DTSP(动态旅行商问题)十分类似,都是对节点遍历且不重复,但是有两点不同之处,首先是一般旅行商问题的节点就是一个点,彼此之间的距离是确定的,而作业路径排序中的“节点”则是一条植保无人机的作业路径,是由两个点组成的线段,彼此之间的距离是不确定的,具有四种可能性。其次DTSP城市节点的动态变化(例如城市坐标改变、城市间路径权重改变、城市增加或消亡等)在优化迭代过程中每间隔若干代发生一次,而无人机由于选择作业路径的不同,生成返航点的数量和位置也不相同,这与动态旅行商问题具有相似的特征,但二者有本质区别。
发明内容
本发明的目的是解决植保无人机电池电量的不足,提供一种基于改进蚁群算法的多架次作业植保无人机路径规划方法,是一种可以得到全局最优节能路径规划的方法,有效节约植保无人机的电池电量。
本发明的目的至少通过如下技术方案之一实现。
基于蚁群算法的无人船节能路径规划方法,包括以下步骤:
步骤2)删去不符合约束条件的作业路径端点,相邻的作业路径端点依次两两配对,每一对交点之间的连线为植保无人机的作业路径;
步骤4)蚁群算法参数初始化和设定植保无人机的补给点(即起点和终点)
步骤5)随机选取一条植保无人机作业路径起点,判断剩余电量是否能够飞至作业路径终点后仍能返航至补给点,若能够飞到作业路径终点,则作业至终点后转至步骤6);反之则计算出作业路径中返航点的位置,植保无人机返航补给后再重复步骤5);
步骤6)判断是否完成所有作业路径,若没完成则根据转移概率公式选择选择下一条作业路径起点,然后再判断剩余电量能否飞至下一条作业路径起点后仍能返航至补给点,若能够飞至返航点,则转至步骤5);反之则再当前作业路径终点处返航补给,然后再转至步骤5);若已完成所有作业路径,则转至步骤7);
步骤7)更新信息素,每次迭代完成,若此时迭代次数小于最大迭代次数,则通过作业路径端点之间、作业路径端点到作业路径和作业路径之间3个的信息素增量矩阵来计算路径上的信息素浓度,若迭代次数大于最大迭代次数,则输出最终作业路径排序优化结果。
进一步地,在步骤2)中,扫描线与多边形作业区域相交时,有几率会出现扫描线与顶点相交的情况,因此会产生两个相同的交点。针对这种情况,可以把重合的两个点视作一个作业路径端点,再对该顶点的左右顶点进行判断,若左右顶点的纵坐标同时大于或小于该顶点的纵坐标,则从作业路径端点集中删掉该点。如若不是,则该点视为作业路径端点,再依次两两配对生成植保无人机作业路径集。
进一步地,步骤6)中,改进蚁群算法中,通过转移概率公式来选择下一条作业路径,转移概率公式如下:
其中分别是作业路径的终点和起点;为第只蚂蚁从到的转移概率;为信息素因子;为启发函数因子;为在时刻作业路径终点到作业路径起点的信息素;为在时刻作业路径终点到作业路径起点的启发函数,启发函数为距离的倒数;为尚未访问过的节点的集合。
考虑植保无人机电池续航能力,每只蚂蚁都可能会生成新的返航点,若返航点位于作业路径上,则会产生一个新的作业路径端点。由于产生了一个新的作业路径端点从而导致原启发函数距离矩阵不准确,因此需要对启发函数实时更新,以保证转移概率函数的准确性。
进一步地,步骤7)中,为了提高改进蚁群算法寻找最优路径的准确性,采取3个的信息素增量矩阵来计算路径上的信息素浓度,信息素更新公式如下:
所有蚂蚁跑完一次视为一次迭代,设置最大迭代次数,达到最大迭代次数即得到全局最优节能路径规划;对于蚂蚁少的路径,其信息素会越来越少,也就是选择的概率会越来越低,蚂蚁多的路径,信息素积累得越来越多,选择的概率越来越高。
相比于现有技术,本发明的优点在于:
更少的作业路径。通过作业路径生成算法求得既能覆盖整个作业区域数量同时最少的作业路径集,植保无人机飞行路径最短即消耗能量最少。
附图说明
图1是本发明的整体流程图;
图2是路径生成算法流程图;
图3是改进的蚁群算法流程图;
图4是植保无人机在矩形区域进行喷施的路线示意图;
图5扫描线与作业区域交点图;
图6是植保无人机返航点的位置示意图;
图7是在规则区域内的改进蚁群算法规划的植保无人机飞行路径图;
图8是在规则区域内的贪婪算法规划的植保无人机飞行路径图;
图9是在不规则区域内的改进蚁群算法规划的植保无人机飞行路径图;
图10是在不规则区域内的贪婪算法规划的植保无人机飞行路径图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚明白,下面结合附图并举实施例,对本发明的具体实施进行详细说明。
如图1所示的一种基于改进蚁群算法的多架次作业植保无人机路径规划的方法主要分为两部分,分别是路径生成算法和改进的蚁群算法。路径生成算法能够帮助植保无人机找到数量最少的作业路径集,改进的蚁群算法对作业路径排序优化,选择植保无人机飞行路径最短的作业路径排序。
步骤2)删去不符合约束条件的作业路径端点,相邻的作业路径端点依次两两配对,每一对交点之间的连线为植保无人机的作业路径;
如图5所示,扫描线与多边形作业区域相交时,有几率会出现扫描线与顶点相交的情况,因此会产生两个相同的交点。扫描线S1与多边形区域边界和边界都相交于点,与边界和相交于点,与边界和相交于点,与边界、和相交于点、和。处理两个点重合的情况时,把重合的两个点视作一个作业路径端点,再依次两两配对,则会得到线段、和,其中有效作业路径为线段,而和则位于多边形作业区域外,这显然是不正确的。
针对上述问题,需要对位于作业区域顶点上的交点的左右顶点进行判断,若左右顶点的纵坐标同时大于或小于该顶点的纵坐标,则从作业路径端点集中删掉该点。如若不是,则该点视为作业路径端点。然后再依次两两配对,构成植保无人机再航向角下的作业路径集。
步骤4)蚁群算法参数初始化和设定植保无人机的补给点(即起点和终点)
步骤5)随机选取一条植保无人机作业路径起点,判断剩余电量是否能够飞至作业路径终点后仍能返航至补给点,若能够飞到作业路径终点,则作业至终点后转至步骤6);反之则计算出作业路径中返航点的位置,植保无人机返航补给后再重复步骤5);
选取一条植保无人机作业路径起点,通过起点序号的奇偶来判断作业路径终点的编号,若起点序号为奇数,则终点的序号为起点序号+1;若起点序号为偶数,则终点序号为起点序号-1。
如图6所示,作业路径和转移路径是相间排列的,作业路径为 ,转移路径为 。植保无人机电池的消耗量与飞行的累计路程是息息相关的,假设植保无人机每公里消耗的电量是相同的,把剩余电量转化为植保无人机的剩余路程。当植保无人机执行作业任务时,需要对每一条航线的任意点进行剩余电量监测。
对于具有条作业路径的模型而言,按次序飞行至航点的累计里程用来表示,从航点返航补给的路程为,植保无人机单次飞行总路程为,第条作业路径用来表示,其中为作业路径起点编号,为作业路径终点编号,则植保无人机在返航之前的飞行距离为:
步骤6)判断是否完成所有作业路径,若没完成则根据转移概率公式选择选择下一条作业路径起点,然后再判断剩余电量能否飞至下一条作业路径起点后仍能返航至补给点,若能够飞至返航点,则转至步骤5);反之则再当前作业路径终点处返航补给,然后再转至步骤5);若已完成所有作业路径,则转至步骤7);
改进蚁群算法中,通过转移概率公式来选择下一条作业路径,转移概率公式如下:
其中分别是作业路径的终点和起点;为第只蚂蚁从到的转移概率;为信息素因子;为启发函数因子;为在时刻作业路径终点到作业路径起点的信息素;为在时刻作业路径终点到作业路径起点的启发函数,启发函数为距离的倒数;为尚未访问过的节点的集合。
步骤7)更新信息素,每次迭代完成,若此时迭代次数小于最大迭代次数,则通过作业路径端点之间、作业路径端点到作业路径和作业路径之间3个的信息素增量矩阵来计算路径上的信息素浓度,若迭代次数大于最大迭代次数,则输出最终作业路径排序优化结果。
为了提高改进蚁群算法寻找最优路径的准确性,采取3个的信息素增量矩阵来计算路径上的信息素浓度,信息素更新公式如下:
所有蚂蚁跑完一次视为一次迭代,设置最大迭代次数,达到最大迭代次数即得到全局最优节能路径规划;对于蚂蚁少的路径,其信息素会越来越少,也就是选择的概率会越来越低,蚂蚁多的路径,信息素积累得越来越多,选择的概率越来越高。
首先在规则区域内进行试验,实验结果如图7和图8所示,改进蚁群算法相比单一的贪婪算法大大减少了无人机的转弯次数和飞行距离,改进后的蚁群算法在搜索初期就避免了盲目性、有良好的正反馈,提高了算法的收敛速度,获得最优解。
为了进一步验证复杂环境中本发明改进蚁群算法的适应性和有效性,采取多个复杂的多边形作业区域来实验,实验结果如图9和图10所示,改进蚁群算法同样比贪婪算法在飞行距离上优越约11%。
本发明并不局限于上述实施例,在本发明公开的技术方案的基础上,本领域的技术人员根据所公开的技术内容,不需要创造性的劳动就可以对其中的一些技术特征作出一些替换和变形,这些替换和变形均在本发明的保护范围内。
Claims (4)
1.一种基于改进蚁群算法的多架次作业植保无人机路径规划方法,其特征在于,包括以下步骤:
步骤2)删去不符合约束条件的作业路径端点,相邻的作业路径端点依次两两配对,每一对交点之间的连线为植保无人机的作业路径;
步骤5)随机选取一条植保无人机作业路径起点,判断剩余电量是否能够飞至作业路径终点后仍能返航至补给点,若能够飞到作业路径终点,则作业至终点后转至步骤6);反之则计算出作业路径中返航点的位置,植保无人机返航补给后再重复步骤5);
步骤6)判断是否完成所有作业路径,若没完成则根据转移概率公式选择选择下一条作业路径起点,然后再判断剩余电量能否飞至下一条作业路径起点后仍能返航至补给点,若能够飞至返航点,则转至步骤5);反之则再当前作业路径终点处返航补给,然后再转至步骤5);若已完成所有作业路径,则转至步骤7);
步骤7)更新信息素,每次迭代完成,若此时迭代次数小于最大迭代次数,则通过作业路径端点之间、作业路径端点到作业路径和作业路径之间3个的信息素增量矩阵来计算路径上的信息素浓度,若迭代次数大于最大迭代次数,则输出最终作业路径排序优化结果。
2.根据权利要求1所述的改进蚁群算法的多架次作业植保无人机路径规划方法,其特征在于,步骤2)中,扫描线与多边形作业区域相交时,有几率会出现扫描线与顶点相交的情况,因此会产生两个相同的交点,针对这种情况,可以把重合的两个点视作一个作业路径端点,再对该顶点的左右顶点进行判断,若左右顶点的纵坐标同时大于或小于该顶点的纵坐标,则从作业路径端点集中删掉该点,如若不是,则该点视为作业路径端点,再依次两两配对生成植保无人机作业路径集。
3.根据权利要求1所述的改进蚁群算法的多架次作业植保无人机路径规划方法,其特征在于,步骤6)中,改进蚁群算法中,通过转移概率公式来选择下一条作业路径,转移概率公式如下:
其中分别是作业路径的终点和起点;为第只蚂蚁从到的转移概率;为信息素因子;为启发函数因子;为在时刻作业路径终点到作业路径起点的信息素;为在时刻作业路径终点到作业路径起点的启发函数,启发函数为距离的倒数;为尚未访问过的节点的集合,
考虑植保无人机电池续航能力,每只蚂蚁都可能会生成新的返航点,若返航点位于作业路径上,则会产生一个新的作业路径端点,
由于产生了一个新的作业路径端点从而导致原启发函数距离矩阵不准确,因此需要对启发函数实时更新,以保证转移概率函数的准确性。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111122205.3A CN113703488A (zh) | 2021-09-24 | 2021-09-24 | 基于改进蚁群算法的多架次作业植保无人机路径规划方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111122205.3A CN113703488A (zh) | 2021-09-24 | 2021-09-24 | 基于改进蚁群算法的多架次作业植保无人机路径规划方法 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN113703488A true CN113703488A (zh) | 2021-11-26 |
Family
ID=78661752
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111122205.3A Withdrawn CN113703488A (zh) | 2021-09-24 | 2021-09-24 | 基于改进蚁群算法的多架次作业植保无人机路径规划方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN113703488A (zh) |
Cited By (2)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114326804A (zh) * | 2021-12-28 | 2022-04-12 | 广州极飞科技股份有限公司 | 航线规划方法、作业控制方法及相关装置 |
CN114764251A (zh) * | 2022-05-13 | 2022-07-19 | 电子科技大学 | 一种基于能耗模型的多智能体协同搜索节能方法 |
-
2021
- 2021-09-24 CN CN202111122205.3A patent/CN113703488A/zh not_active Withdrawn
Cited By (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN114326804A (zh) * | 2021-12-28 | 2022-04-12 | 广州极飞科技股份有限公司 | 航线规划方法、作业控制方法及相关装置 |
CN114326804B (zh) * | 2021-12-28 | 2023-06-09 | 广州极飞科技股份有限公司 | 航线规划方法、作业控制方法及相关装置 |
CN114764251A (zh) * | 2022-05-13 | 2022-07-19 | 电子科技大学 | 一种基于能耗模型的多智能体协同搜索节能方法 |
CN114764251B (zh) * | 2022-05-13 | 2023-10-10 | 电子科技大学 | 一种基于能耗模型的多智能体协同搜索节能方法 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN103699135B (zh) | 无人直升机农药喷洒农田作业区域的航迹自动规划方法 | |
CN110941261B (zh) | 一种自主式水下航行器多区域遍历路径规划方法 | |
CN104503464B (zh) | 基于计算机的凸多边形农田无人机喷洒作业航迹规划方法 | |
CN110530388B (zh) | 多agv的路径规划方法及*** | |
CN107037827B (zh) | 无人机航空作业任务分配与航迹规划联合优化方法及装置 | |
CN113703488A (zh) | 基于改进蚁群算法的多架次作业植保无人机路径规划方法 | |
CN112650229B (zh) | 一种基于改进蚁群算法的移动机器人路径规划方法 | |
CN107622327A (zh) | 基于文化蚁群搜索机制的多无人机航迹规划方法 | |
CN105841702A (zh) | 一种基于粒子群优化算法的多无人机航路规划方法 | |
CN109357685A (zh) | 航路网生成方法、装置及存储介质 | |
CN111323016A (zh) | 一种基于自适应蚁群算法的移动机器人路径规划方法 | |
CN108413963A (zh) | 基于自学习蚁群算法的条形机器人路径规划方法 | |
Li et al. | Mobile robot path planning based on improved genetic algorithm with A-star heuristic method | |
CN111189455B (zh) | 一种无人机航路规划方法、***及存储介质 | |
CN115454132A (zh) | 一种面向山地光伏电站的无人机巡检三维路径规划方法及*** | |
Yu et al. | Balanced multi-region coverage path planning for unmanned aerial vehicles | |
Lu et al. | Tmstc*: A path planning algorithm for minimizing turns in multi-robot coverage | |
Wang et al. | Autonomous vehicles path planning with enhanced ant colony optimization | |
CN113649206A (zh) | 一种用于船体建造喷漆的轨迹生成优化方法 | |
CN113589841A (zh) | 无人机航线生成方法、无人机及计算机可读存储介质 | |
Gao et al. | Competitive self-organizing neural network based UAV path planning | |
Huang et al. | A multi-robot coverage path planning algorithm based on improved darp algorithm | |
Cheng et al. | Route planning of mixed ant colony algorithm based on Dubins path | |
Zhang et al. | Research on complete coverage path planning for unmanned surface vessel | |
CN114911254A (zh) | 基于Laguerre图的无人机突防路径规划方法 |
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 | ||
WW01 | Invention patent application withdrawn after publication |
Application publication date: 20211126 |
|
WW01 | Invention patent application withdrawn after publication |