CN114326700A - 巡逻船区域覆盖路径规划方法、系统及装置 - Google Patents
巡逻船区域覆盖路径规划方法、系统及装置 Download PDFInfo
- Publication number
- CN114326700A CN114326700A CN202111385256.5A CN202111385256A CN114326700A CN 114326700 A CN114326700 A CN 114326700A CN 202111385256 A CN202111385256 A CN 202111385256A CN 114326700 A CN114326700 A CN 114326700A
- Authority
- CN
- China
- Prior art keywords
- area
- coverage
- patrol
- covered
- task
- 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.)
- Pending
Links
- 238000000034 method Methods 0.000 title claims abstract description 103
- 238000005457 optimization Methods 0.000 claims abstract description 22
- 238000010845 search algorithm Methods 0.000 claims abstract description 16
- 230000011218 segmentation Effects 0.000 claims description 11
- 230000009977 dual effect Effects 0.000 abstract 1
- 238000012544 monitoring process Methods 0.000 description 8
- 238000004891 communication Methods 0.000 description 5
- 238000010586 diagram Methods 0.000 description 4
- 230000008569 process Effects 0.000 description 4
- 238000001514 detection method Methods 0.000 description 3
- 238000003860 storage Methods 0.000 description 3
- 230000006870 function Effects 0.000 description 2
- 238000012545 processing Methods 0.000 description 2
- 239000004576 sand Substances 0.000 description 2
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 2
- 230000001413 cellular effect Effects 0.000 description 1
- 238000000576 coating method Methods 0.000 description 1
- 238000004883 computer application Methods 0.000 description 1
- 230000007123 defense Effects 0.000 description 1
- 238000011161 development Methods 0.000 description 1
- 230000018109 developmental process Effects 0.000 description 1
- 238000005516 engineering process Methods 0.000 description 1
- 238000012423 maintenance Methods 0.000 description 1
- 238000004519 manufacturing process Methods 0.000 description 1
- 238000012986 modification Methods 0.000 description 1
- 230000004048 modification Effects 0.000 description 1
- 230000003287 optical effect Effects 0.000 description 1
- 230000002093 peripheral effect Effects 0.000 description 1
- 238000006467 substitution reaction Methods 0.000 description 1
- 238000012546 transfer Methods 0.000 description 1
Images
Landscapes
- Traffic Control Systems (AREA)
Abstract
本发明公开了一种巡逻船区域覆盖路径规划方法、系统及装置,该方法包括:确定巡逻船的数量、航速、扫描宽度和海域地图;将海域地图建模为方形栅格地图,确定障碍物区域和待覆盖区域;对待覆盖区域进行划分,确定巡逻船的任务区域;以往返式覆盖法或螺旋式覆盖法对任务区域进行扫描,实时判断覆盖率是否达到预设覆盖率,若否,判断覆盖路径是否陷入死角,若是,利用广度优先搜索算法寻找与巡逻船当前位置曼哈顿距离最小的未覆盖区域,确定最短路径,以往返式覆盖法或螺旋式覆盖法对未覆盖区域进行扫描,并实时判断覆盖率是否达到预设覆盖率。本发明能够满足预设优化目标和海域地图覆盖率的双重要求,实现巡逻船航行路径自动规划,提高巡逻效率。
Description
技术领域
本发明涉及海域巡查技术领域,尤其涉及一种巡逻船区域覆盖路径规划方法、系统及装置。
背景技术
目前,在海洋巡逻和海域监控方面,虽然可以配备专业化的海防力量来执行相关任务,例如配备一定数量的巡逻飞机、巡逻船等,但是面对大范围的海洋巡逻与监控任务,传统的海洋巡逻与监控模式很难做到高效率,且存在人员、装备运维成本高等问题。
随着智能制造技术的大力发展,以无人机、无人船、无人潜水器为代表的低成本装备逐渐走向成熟,并在军事作战与反恐、资源勘探、水质检测与治理及水上搜救等领域开始实际应用,这为基于无人装备开展海洋巡逻与海域监控提供了重要借鉴作用。相比于传统的海洋巡逻与监控模式,无人装备的应用能够大大提供工作效率,极大地缩小海洋区域巡逻监控的时间,并减少人员、能源等运营成本,同时规避人员在危险海域执行任务的风险,拥有更具前景的应用价值和经济价值。然而,目前针对无人巡逻船的巡逻路径规划的研究较少,缺乏能够应用于无人巡逻船的航行路径规划方法,导致无人巡逻船的应用受到极大限制。
发明内容
为解决上述现有技术中存在的部分或全部技术问题,本发明提供一种巡逻船区域覆盖路径规划方法、系统及装置。
本发明的技术方案如下:
第一方面,提供了一种巡逻船区域覆盖路径规划方法,所述方法包括以下步骤:
S1,确定巡逻船的数量、巡逻船的航速、巡逻船的扫描宽度和待巡逻的海域地图;
S2,将海域地图建模为方形栅格地图,并确定障碍物区域和待覆盖区域,其中,障碍物区域表示所有存在障碍物的方形栅格构成的区域,待覆盖区域表示所有未存在障碍物的方形栅格构成的区域;
S3,根据巡逻船的数量和预设优化目标,对待覆盖区域进行划分,确定每个巡逻船的任务区域;
S4,以往返式覆盖法或螺旋式覆盖法对巡逻船的任务区域进行扫描,并实时判断任务区域的覆盖率是否达到预设覆盖率;
S5,若任务区域的覆盖率达到预设覆盖率,则结束路径规划;
S6,若任务区域的覆盖率未达到预设覆盖率,则判断覆盖路径是否陷入死角;
S7,若覆盖路径未陷入死角,则继续以往返式覆盖法或螺旋式覆盖法对巡逻船的任务区域或未覆盖区域进行扫描,并实时判断任务区域的覆盖率是否达到预设覆盖率,若是,执行步骤S5,若否,执行步骤S6;
S8,若覆盖路径陷入死角,则利用广度优先搜索算法寻找与巡逻船当前位置曼哈顿距离最小的未覆盖区域,确定最短路径,从当前位置沿最短路径到达最近的未覆盖区域,以往返式覆盖法或螺旋式覆盖法对未覆盖区域进行扫描,并实时判断任务区域的覆盖率是否达到预设覆盖率,若是,执行步骤S5,若否,执行步骤S6。
在一些可能的实现方式中,方形栅格的宽度等于巡逻船的扫描宽度。
在一些可能的实现方式中,当巡逻船的数量为1个时,巡逻船的任务区域为待覆盖区域。
在一些可能的实现方式中,设定巡逻船的数量为大于1个,设定预设优化目标为完成待覆盖区域覆盖的所需时间最短,采用对待覆盖区域进行面积近似的等量切分方式对待覆盖区域进行划分,确定每个巡逻船的任务区域。
在一些可能的实现方式中,采用对待覆盖区域进行面积近似的等量切分方式对待覆盖区域进行划分,确定每个巡逻船的任务区域,包括:
从方形栅格地图左侧的第一列栅格开始逐列向右扫描或者从方形栅格地图右侧的第一列栅格开始逐列向左扫描,将扫描过的每列的待覆盖的栅格面积进行累加,当扫描到第ci列时累加的待覆盖的栅格面积之和Si满足时,将第ci-1+1列到第ci列对应的待覆盖区域划分为第i个巡逻船的任务区域,其中,i=1,2,...n,c0=0,Sω表示待覆盖区域的总面积,n表示巡逻船的数量。
在一些可能的实现方式中,采用对待覆盖区域进行面积近似的等量切分方式对待覆盖区域进行划分,确定每个巡逻船的任务区域,包括:
从方形栅格地图上侧的第一行栅格开始逐行向下扫描或者从方形栅格地图下侧的第一行栅格开始逐行向上扫描,将扫描过的每行的待覆盖的栅格面积进行累加,当扫描到第hi行时累加的待覆盖的栅格面积之和Ri满足时,将第hi-1+1行到第hi行对应的待覆盖区域划分为第i个巡逻船的任务区域,其中,i=1,2,...n,h0=0,Sω表示待覆盖区域的总面积,n表示巡逻船的数量。
第二方面,还提供了一种巡逻船区域覆盖路径规划系统,所述系统包括:
参数确定模块,用于确定巡逻船的数量、巡逻船的航速、巡逻船的扫描宽度和待巡逻的海域地图;
栅格地图生成模块,用于将海域地图建模为方形栅格地图,并确定障碍物区域和待覆盖区域;
区域划分模块,用于根据巡逻船的数量和预设优化目标,对待覆盖区域进行划分,确定每个巡逻船的任务区域;
首次遍历路径规划模块,用于以往返式覆盖法或螺旋式覆盖法对巡逻船的任务区域进行扫描;
覆盖情况判断模块,用于实时判断任务区域的覆盖率是否达到预设覆盖率;
覆盖路径判断模块,用于在覆盖情况判断模块确定任务区域的覆盖率未达到预设覆盖率后,判断覆盖路径是否陷入死角;
跨区路径规划模块,用于在任务区域的覆盖率未达到预设覆盖率且覆盖路径陷入死角时,利用广度优先搜索算法寻找与巡逻船当前位置曼哈顿距离最小的未覆盖区域,并确定最短路径;
区域路径规划模块,用于以往返式覆盖法或螺旋式覆盖法对未覆盖区域进行扫描。
第三方面,还提供了一种巡逻船区域覆盖路径规划装置,所述装置包括存储器和处理器;
所述存储器存储有至少一条指令;
所述处理器用于加载并执行所述存储器中的指令,以执行上述的巡逻船区域覆盖路径规划方法。
本发明技术方案的主要优点如下:
本发明的巡逻船区域覆盖路径规划方法、系统及装置根据巡逻船的具体参数对海域地图进行栅格地图建模,根据预设优化目标对海域地图进行区域划分,利用往返式覆盖法或螺旋式覆盖法对巡逻船的任务区域进行扫描,当覆盖率未达到要求且覆盖路径陷入死角时,利用广度优化搜索算法寻找最近的未覆盖区域,并利用往返式覆盖法或螺旋式覆盖法对未覆盖区域进行扫描,能够满足预设优化目标和海域地图的覆盖率的双重要求,实现巡逻船的航行路径自动规划,降低海域巡逻所需时间,提高海域巡逻效率。
附图说明
此处所说明的附图用来提供对本发明实施例的进一步理解,构成本发明的一部分,本发明的示意性实施例及其说明用于解释本发明,并不构成对本发明的不当限定。在附图中:
图1为本发明一实施例的巡逻船区域覆盖路径规划方法的流程图;
图2为本发明示例1给出的一种海域示意图;
图3为图2对应的方形栅格地图;
图4为本发明示例1给出的一种任务区域划分结果示意图;
图5为本发明一实施例的巡逻船区域覆盖路径规划系统的结构示意图;
图6为本发明一实施例的巡逻船区域覆盖路径规划装置的结构示意图。
具体实施方式
为使本发明的目的、技术方案和优点更加清楚,下面将结合本发明具体实施例及相应的附图对本发明技术方案进行清楚、完整地描述。显然,所描述的实施例仅是本发明的一部分实施例,而不是全部的实施例。基于本发明的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
以下结合附图,详细说明本发明实施例提供的技术方案。
第一方面,参见图1,本发明一实施例提供了一种巡逻船区域覆盖路径规划方法,该方法包括以下步骤:
S1,确定巡逻船的数量、巡逻船的航速、巡逻船的扫描宽度和待巡逻的海域地图;
S2,将海域地图建模为方形栅格地图,并确定障碍物区域和待覆盖区域,其中,障碍物区域表示所有存在障碍物的方形栅格构成的区域,待覆盖区域表示所有未存在障碍物的方形栅格构成的区域;
S3,根据巡逻船的数量和预设优化目标,对待覆盖区域进行划分,确定每个巡逻船的任务区域;
S4,以往返式覆盖法或螺旋式覆盖法对巡逻船的任务区域进行扫描,并实时判断任务区域的覆盖率是否达到预设覆盖率;
S5,若任务区域的覆盖率达到预设覆盖率,则结束路径规划;
S6,若任务区域的覆盖率未达到预设覆盖率,则判断覆盖路径是否陷入死角;
S7,若覆盖路径未陷入死角,则继续以往返式覆盖法或螺旋式覆盖法对巡逻船的任务区域或未覆盖区域进行扫描,并实时判断任务区域的覆盖率是否达到预设覆盖率,若是,执行步骤S5,若否,执行步骤S6;
S8,若覆盖路径陷入死角,则利用广度优先搜索算法寻找与巡逻船当前位置曼哈顿距离最小的未覆盖区域,确定最短路径,从当前位置沿最短路径到达最近的未覆盖区域,以往返式覆盖法或螺旋式覆盖法对未覆盖区域进行扫描,并实时判断任务区域的覆盖率是否达到预设覆盖率,若是,执行步骤S5,若否,执行步骤S6。
本发明一实施例提供的巡逻船区域覆盖路径规划方法根据巡逻船的具体参数对海域地图进行栅格地图建模,根据预设优化目标对海域地图进行区域划分,利用往返式覆盖法或螺旋式覆盖法对巡逻船的任务区域进行扫描,当覆盖率未达到要求且覆盖路径陷入死角时,利用广度优化搜索算法寻找最近的未覆盖区域,并利用往返式覆盖法或螺旋式覆盖法对未覆盖区域进行扫描,能够满足预设优化目标和海域地图的覆盖率的双重要求,实现巡逻船的航行路径自动规划,降低海域巡逻所需时间,提高海域巡逻效率。
由于栅格大小的设定会影响覆盖效率,若栅格过大会导致有些区域过度覆盖,若栅格过小则会导致覆盖时间过长。考虑到海域障碍物一般为岛屿,岛屿的大小通常远大于无人巡逻船探测传感器的扫描宽度。本发明一实施例中,将方形栅格的宽度设置为巡逻船的扫描宽度,以最大程度提高探测扫描的效率。
在实际海域巡逻应用场景中,优化目标通常为完成待覆盖区域覆盖的所需时间最短,即最小化耗时最长的巡逻船的执行任务时间,以提高海域巡逻效率。
具体地,在预设优化目标为完成待覆盖区域覆盖的所需时间最短时,根据巡逻船的数量和预设优化目标,对待覆盖区域进行划分,确定每个巡逻船的任务区域,具体包括:
当巡逻船的数量为1个时,将待覆盖区域划分为巡逻船的任务区域;
当巡逻船的数量为大于1个时,采用对待覆盖区域进行面积近似的等量切分方式对待覆盖区域进行划分,确定每个巡逻船的任务区域。
通过采用等量切分方式对待覆盖区域进行划分,能够保证每个巡逻船负责巡逻监控的任务区域面积尽可能相同,且能够保证巡逻船的巡逻作业分工明确,避免出现路径相互重叠和干扰,提高多个巡逻船的协作效率。
作为一种示例,本发明一实施例中,采用对待覆盖区域进行面积近似的等量切分方式对待覆盖区域进行划分,确定每个巡逻船的任务区域,可以包括:
从方形栅格地图左侧的第一列栅格开始逐列向右扫描或者从方形栅格地图右侧的第一列栅格开始逐列向左扫描,将扫描过的每列的待覆盖的栅格面积进行累加,当扫描到第ci列时累加的待覆盖的栅格面积之和Si满足时,将第ci-1+1列到第ci列对应的待覆盖区域划分为第i个巡逻船的任务区域,其中,i=1,2,...n,c0=0,Sω表示待覆盖区域的总面积,n表示巡逻船的数量。
作为另一种示例,本发明一实施例中,采用对待覆盖区域进行面积近似的等量切分方式对待覆盖区域进行划分,确定每个巡逻船的任务区域,可以包括:
从方形栅格地图上侧的第一行栅格开始逐行向下扫描或者从方形栅格地图下侧的第一行栅格开始逐行向上扫描,将扫描过的每行的待覆盖的栅格面积进行累加,当扫描到第hi行时累加的待覆盖的栅格面积之和Ri满足时,将第hi-1+1行到第hi行对应的待覆盖区域划分为第i个巡逻船的任务区域,其中,i=1,2,...n,h0=0,Sω表示待覆盖区域的总面积,n表示巡逻船的数量。
本发明一实施例中,所采用的往返式覆盖法和螺旋式覆盖法均为本领域常规的区域遍历算法,所采用的广度优先搜索算法为本领域常规的路径搜索算法。往返式覆盖法的步骤及原理例如可以参见技术文献:“Choset H,Pignon P.Coverage path planning:theboustrophedon cellular decomposition[C].Field and service robotics.Springer,London,1998:203-209”。螺旋式覆盖法的步骤及原理例如可以参见技术文献:“基于栅格地图的机器人覆盖路径规划研究[J].郝宗波等,计算机应用研究,第24卷第10期,第56-58页,2007年”。广度优先搜索算法的步骤及原理例如可以参见技术文献:“Tripathy H K,MishraS,Thakkar H K,et al.CARE:A collision-aware mobile robot navigation in gridenvironment using improved breadth first search[J].Computers&ElectricalEngineering,2021,94:107327”。
为使本发明的上述技术方案更加清楚,下面将结合具体示例对本发明的技术方案进行清楚、完整地描述。显然,所描述的示例仅是本发明的一部分实施例,而不是全部的实施例。
示例1
该示例1以三沙市-西沙群岛周边海域作为海域巡逻任务的应用场景。
巡逻船的参数设定为:巡逻船的数量n=10,探测航速vship=20km,扫描宽度wship=2km。海域地图如图2所示,海域覆盖范围长度约为130km,宽度约为120km,海域面积为S=15990km2。
参见图3,将海域地图建模为方形栅格地图,方形栅格的宽度wgrid=wship,方形栅格地图包括障碍物区域和待覆盖区域,待覆盖区域面积为Sω=13764km2。
参见图4,以5个巡逻船协同执行海域覆盖任务为例,采用对待覆盖区域进行面积近似的等量切分方式对待覆盖区域进行划分,具体以上述的逐列扫描划分方式对待覆盖区域进行划分,确定5个巡逻船的任务区域,得到的5个任务区域面积分别占比20.8%、20.4%、20%、19.8%和19%。
以往返式覆盖法对巡逻船的任务区域进行扫描,在任务区域的覆盖率未达到预设覆盖率且覆盖路径陷入死角的情况下,利用广度优先搜索算法寻找与巡逻船当前位置曼哈顿距离最小的未覆盖区域,并确定最短路径,从当前位置沿最短路径到达最近的未覆盖区域,以往返式覆盖法对未覆盖区域进行扫描,直至任务区域的覆盖率达到预设覆盖率,得到一种路径规划结果。
以螺旋式覆盖法对巡逻船的任务区域进行扫描,在任务区域的覆盖率未达到预设覆盖率且覆盖路径陷入死角的情况下,利用广度优先搜索算法寻找与巡逻船当前位置曼哈顿距离最小的未覆盖区域,并确定最短路径,从当前位置沿最短路径到达最近的未覆盖区域,以螺旋式覆盖法对未覆盖区域进行扫描,直至任务区域的覆盖率达到预设覆盖率,得到另一种路径规划结果。
以下表1给出了在预设覆盖率JCR为100%,巡逻船的数量分别为1、5、10条件下的路径规划结果对应的指标数据。
表1
基于表1的数据可知,由于巡逻船数量越多任务区域的划分会越分散,巡逻船在众多任务区域内需要跨越的区域总体会变多,路径重复率和总步数会适度上升。巡逻船的数量越多,完成海域覆盖所需时间越短。在同等条件下,采用往返式覆盖法的重复率、总步数和总时间均略低于采用螺旋式覆盖法,在进行路径规划时,可以优先采用往返式覆盖法。
第二方面,参见图5,本发明一实施例还提供了一种巡逻船区域覆盖路径规划系统100,该系统100包括:
参数确定模块101,用于确定巡逻船的数量、巡逻船的航速、巡逻船的扫描宽度和待巡逻的海域地图;
栅格地图生成模块102,用于将海域地图建模为方形栅格地图,并确定障碍物区域和待覆盖区域;
区域划分模块103,用于根据巡逻船的数量和预设优化目标,对待覆盖区域进行划分,确定每个巡逻船的任务区域;
首次遍历路径规划模块104,用于以往返式覆盖法或螺旋式覆盖法对巡逻船的任务区域进行扫描;
覆盖情况判断模块105,用于实时判断任务区域的覆盖率是否达到预设覆盖率;
覆盖路径判断模块106,用于在覆盖情况判断模块确定任务区域的覆盖率未达到预设覆盖率后,判断覆盖路径是否陷入死角;
跨区路径规划模块107,用于在任务区域的覆盖率未达到预设覆盖率且覆盖路径陷入死角时,利用广度优先搜索算法寻找与巡逻船当前位置曼哈顿距离最小的未覆盖区域,并确定最短路径;
区域路径规划模块108,用于以往返式覆盖法或螺旋式覆盖法对未覆盖区域进行扫描。
具体地,本发明一实施例提供的巡逻船区域覆盖路径规划系统在应用时,参数确定模块确定巡逻船的数量、巡逻船的航速、巡逻船的扫描宽度和待巡逻的海域地图;栅格地图生成模块根据参数确定模块确定的巡逻船的具体参数和待巡逻的海域地图,将海域地图建模为方形栅格地图,并确定障碍物区域和待覆盖区域;区域划分模块根据栅格地图生成模块生成的方形栅格地图、巡逻船的数量和预设优化目标,对待覆盖区域进行划分,确定每个巡逻船的任务区域;基于区域划分模块的划分结果,首次遍历路径规划模块以往返式覆盖法或螺旋式覆盖法对巡逻船的任务区域进行扫描;在首次遍历路径规划模块进行首次扫描时,覆盖情况判断模块实时判断确定任务区域的覆盖率是否达到预设覆盖率,若达到预设覆盖率,则结束路径规划;当任务区域的覆盖率未达到预设覆盖率时,覆盖路径判断模块判断覆盖路径是否陷入死角,若覆盖路径未陷入死角,则首次遍历路径规划模块继续以往返式覆盖法或螺旋式覆盖法对巡逻船的任务区域进行扫描,若覆盖路径陷入死角,则跨区路径规划模块利用广度优先搜索算法寻找与巡逻船当前位置曼哈顿距离最小的未覆盖区域,并确定最短路径,沿最短路径到达最近的未覆盖区域,且在沿最短路径到达最近的未覆盖区域的过程中,覆盖情况判断模块实时判断确定任务区域的覆盖率是否达到预设覆盖率,若达到预设覆盖率,则结束路径规划;在到达最近的未覆盖区域后,区域路径规划模块以往返式覆盖法或螺旋式覆盖法对最近的未覆盖区域进行扫描;在区域路径规划模块对未覆盖区域进行扫描时,覆盖情况判断模块实时判断确定任务区域的覆盖率是否达到预设覆盖率;当任务区域的覆盖率未达到预设覆盖率时,覆盖路径判断模块判断覆盖路径是否陷入死角,若覆盖路径未陷入死角,则区域路径规划模块继续以往返式覆盖法或螺旋式覆盖法对未覆盖区域进行扫描,若覆盖路径陷入死角,则跨区路径规划模块和区域路径规划模块继续执行上述过程,直至任务区域的覆盖率达到预设覆盖率。
第三方面,参见图6,本发明一实施例还提供了一种巡逻船区域覆盖路径规划装置200,该装置200包括存储器201、处理器202、通信接口203和总线204;
存储器201存储有至少一条指令;
处理器202用于加载并执行存储器201中的指令,以执行上述的巡逻船区域覆盖路径规划方法;
通信接口203,用于进行通信,存储器201、处理器202和通信接口203通过总线204相互连接。
本发明一实施例中,上述存储器201可以是随机存取存储器(RAM)、闪存(flash)、只读存储器(ROM)、可擦写可编程只读存储器(EPROM)、电可擦除可编程只读存储器(EEPROM)、寄存器(register)、硬盘、移动硬盘、CD-ROM或者本领域技术人员知晓的任何其他形式的存储介质。
上述处理器202例如可以是中央处理器(CPU)、通用处理器、数字信号处理器(DSP)、专用集成电路(ASIC)、现场可编程门阵列(FPGA)或者其他可编程逻辑器件、晶体管逻辑器件、硬件部件或者其任意组合。其可以实现或执行结合本申请实施例公开内容所描述的各种示例性的逻辑方框和模块。处理器也可以是实现计算功能的组合,例如包含一个或多个微处理器组合,DSP和微处理器的组合等等。该处理器的详细处理过程请参考上述巡逻船区域覆盖路径规划方法的详细描述,这里不再赘述。
上述通信接口203例如可以是接口卡等,可以为以太(Ethernet)接口或异步传输模式(ATM)接口。
上述总线204可以是外设部件互连标准(PCI)总线或扩展工业标准结构(EISA)总线等。总线204可以分为地址总线、数据总线、控制总线等。为便于表示,图6中仅用一条粗线表示,但并不表示仅有一根总线或一种类型的总线。
本发明一实施例提供的巡逻船区域覆盖路径规划方法、系统及装置根据巡逻船的具体参数对海域地图进行栅格地图建模,根据预设优化目标对海域地图进行区域划分,利用往返式覆盖法或螺旋式覆盖法对巡逻船的任务区域进行扫描,当覆盖率未达到要求且覆盖路径陷入死角时,利用广度优化搜索算法寻找最近的未覆盖区域,并利用往返式覆盖法或螺旋式覆盖法对未覆盖区域进行扫描,能够满足预设优化目标和海域地图的覆盖率的双重要求,实现巡逻船的航行路径自动规划,降低海域巡逻所需时间,提高海域巡逻效率。
需要说明的是,在本文中,术语“包括”、“包含”或者其任何其他变体意在涵盖非排他性的包含,从而使得包括一系列要素的过程、方法、物品或者设备不仅包括那些要素,而且还包括没有明确列出的其他要素,或者是还包括为这种过程、方法、物品或者设备所固有的要素。
在本申请所提供的几个实施例中,应该理解到,所揭露的系统和方法,可以通过其它的方式实现。例如,以上所描述的系统实施例仅仅是示意性的,例如,所述模块的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式,例如多个模块可以结合,或者一些特征可以忽略,或不执行。
本领域普通技术人员可以理解实现上述实施例的全部或部分步骤可以通过硬件来完成,也可以通过程序来指令相关的硬件完成,所述的程序可以存储于一种计算机可读存储介质中,上述提到的存储介质可以是只读存储器、磁盘或光盘等。
最后应说明的是:以上实施例仅用于说明本发明的技术方案,而非对其限制;尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当理解:其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换;而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。
Claims (8)
1.一种巡逻船区域覆盖路径规划方法,其特征在于,所述方法包括以下步骤:
S1,确定巡逻船的数量、巡逻船的航速、巡逻船的扫描宽度和待巡逻的海域地图;
S2,将海域地图建模为方形栅格地图,并确定障碍物区域和待覆盖区域,其中,障碍物区域表示所有存在障碍物的方形栅格构成的区域,待覆盖区域表示所有未存在障碍物的方形栅格构成的区域;
S3,根据巡逻船的数量和预设优化目标,对待覆盖区域进行划分,确定每个巡逻船的任务区域;
S4,以往返式覆盖法或螺旋式覆盖法对巡逻船的任务区域进行扫描,并实时判断任务区域的覆盖率是否达到预设覆盖率;
S5,若任务区域的覆盖率达到预设覆盖率,则结束路径规划;
S6,若任务区域的覆盖率未达到预设覆盖率,则判断覆盖路径是否陷入死角;
S7,若覆盖路径未陷入死角,则继续以往返式覆盖法或螺旋式覆盖法对巡逻船的任务区域或未覆盖区域进行扫描,并实时判断任务区域的覆盖率是否达到预设覆盖率,若是,执行步骤S5,若否,执行步骤S6;
S8,若覆盖路径陷入死角,则利用广度优先搜索算法寻找与巡逻船当前位置曼哈顿距离最小的未覆盖区域,确定最短路径,从当前位置沿最短路径到达最近的未覆盖区域,以往返式覆盖法或螺旋式覆盖法对未覆盖区域进行扫描,并实时判断任务区域的覆盖率是否达到预设覆盖率,若是,执行步骤S5,若否,执行步骤S6。
2.根据权利要求1所述的巡逻船区域覆盖路径规划方法,其特征在于,方形栅格的宽度等于巡逻船的扫描宽度。
3.根据权利要求1所述的巡逻船区域覆盖路径规划方法,其特征在于,当巡逻船的数量为1个时,巡逻船的任务区域为待覆盖区域。
4.根据权利要求1所述的巡逻船区域覆盖路径规划方法,其特征在于,设定巡逻船的数量为大于1个,设定预设优化目标为完成待覆盖区域覆盖的所需时间最短,采用对待覆盖区域进行面积近似的等量切分方式对待覆盖区域进行划分,确定每个巡逻船的任务区域。
7.一种巡逻船区域覆盖路径规划系统,其特征在于,所述系统包括:
参数确定模块,用于确定巡逻船的数量、巡逻船的航速、巡逻船的扫描宽度和待巡逻的海域地图;
栅格地图生成模块,用于将海域地图建模为方形栅格地图,并确定障碍物区域和待覆盖区域;
区域划分模块,用于根据巡逻船的数量和预设优化目标,对待覆盖区域进行划分,确定每个巡逻船的任务区域;
首次遍历路径规划模块,用于以往返式覆盖法或螺旋式覆盖法对巡逻船的任务区域进行扫描;
覆盖情况判断模块,用于实时判断任务区域的覆盖率是否达到预设覆盖率;
覆盖路径判断模块,用于在覆盖情况判断模块确定任务区域的覆盖率未达到预设覆盖率后,判断覆盖路径是否陷入死角;
跨区路径规划模块,用于在任务区域的覆盖率未达到预设覆盖率且覆盖路径陷入死角时,利用广度优先搜索算法寻找与巡逻船当前位置曼哈顿距离最小的未覆盖区域,并确定最短路径;
区域路径规划模块,用于以往返式覆盖法或螺旋式覆盖法对未覆盖区域进行扫描。
8.一种巡逻船区域覆盖路径规划装置,所述装置包括存储器和处理器;
所述存储器存储有至少一条指令;
所述处理器用于加载并执行所述存储器中的指令,以执行如权利要求1至6中任一项所述的方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111385256.5A CN114326700A (zh) | 2021-11-22 | 2021-11-22 | 巡逻船区域覆盖路径规划方法、系统及装置 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202111385256.5A CN114326700A (zh) | 2021-11-22 | 2021-11-22 | 巡逻船区域覆盖路径规划方法、系统及装置 |
Publications (1)
Publication Number | Publication Date |
---|---|
CN114326700A true CN114326700A (zh) | 2022-04-12 |
Family
ID=81046532
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202111385256.5A Pending CN114326700A (zh) | 2021-11-22 | 2021-11-22 | 巡逻船区域覆盖路径规划方法、系统及装置 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN114326700A (zh) |
Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108896048A (zh) * | 2018-06-01 | 2018-11-27 | 浙江亚特电器有限公司 | 用于移动载具的路径规划方法 |
CN111562785A (zh) * | 2020-05-15 | 2020-08-21 | 中南大学 | 一种群集机器人协同覆盖的路径规划方法及系统 |
CN111695776A (zh) * | 2020-05-11 | 2020-09-22 | 清华大学 | 无人机集群分布式在线协同区域侦察方法及装置 |
CN112987749A (zh) * | 2021-03-08 | 2021-06-18 | 河南科技大学 | 一种智能割草机器人混合路径规划方法 |
-
2021
- 2021-11-22 CN CN202111385256.5A patent/CN114326700A/zh active Pending
Patent Citations (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN108896048A (zh) * | 2018-06-01 | 2018-11-27 | 浙江亚特电器有限公司 | 用于移动载具的路径规划方法 |
CN111695776A (zh) * | 2020-05-11 | 2020-09-22 | 清华大学 | 无人机集群分布式在线协同区域侦察方法及装置 |
CN111562785A (zh) * | 2020-05-15 | 2020-08-21 | 中南大学 | 一种群集机器人协同覆盖的路径规划方法及系统 |
CN112987749A (zh) * | 2021-03-08 | 2021-06-18 | 河南科技大学 | 一种智能割草机器人混合路径规划方法 |
Non-Patent Citations (1)
Title |
---|
高春庆: "小型无人机协同覆盖侦察路径规划", 《系统工程与电子技术》, pages 1294 - 1299 * |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN109541634B (zh) | 一种路径规划方法、装置和移动设备 | |
CN114839968B (zh) | 一种水面无人艇路径规划方法 | |
Mahmoud et al. | Object detection using adaptive mask RCNN in optical remote sensing images | |
CN110322453A (zh) | 基于位置注意力和辅助网络的3d点云语义分割方法 | |
CN110244720B (zh) | 用于海上无人艇的路径规划方法及系统 | |
CN113420819B (zh) | 一种基于CenterNet的轻量级水下目标检测方法 | |
CN115205264A (zh) | 一种基于改进YOLOv4的高分辨率遥感船舶检测方法 | |
CN110956853A (zh) | 一种多船碰撞预测方法、系统和存储介质 | |
CN111665846B (zh) | 一种基于快速扫描法的水面无人艇路径规划方法 | |
CN114371692B (zh) | 能源约束下的巡逻船区域覆盖路径规划方法、系统及装置 | |
CN114625150A (zh) | 基于危险指数和距离函数的快速蚁群无人艇动态避障方法 | |
CN107153889B (zh) | 水质采样巡航船路径规划最优化方法 | |
CN117389305A (zh) | 一种无人机巡检路径规划方法、系统、设备及介质 | |
Qi et al. | Underwater small target detection based on deformable convolutional pyramid | |
CN109974708B (zh) | 一种无人船航迹规划方法、终端设备及存储介质 | |
CN116678422A (zh) | 基于多邻域规则格网的舰船最短时间航线自动规划方法 | |
CN117007067A (zh) | 一种基于a星算法的河道巡检无人机路径规划方法 | |
Chang et al. | MLSDNet: Multi-class Lightweight SAR Detection Network Based on Adaptive scale distribution attention | |
CN114326700A (zh) | 巡逻船区域覆盖路径规划方法、系统及装置 | |
CN116255985A (zh) | 一种三维环境的搜救rov路径规划系统及方法 | |
CN115496998A (zh) | 一种遥感影像码头目标检测方法 | |
CN114814796A (zh) | 基于高精度地图的水面可行驶区域提取方法、装置及设备 | |
CN114005045A (zh) | 基于轻量级深度神经网络的旋转框遥感目标检测方法 | |
Luo et al. | Multi-unmanned vehicle for region traversal search based on ant colony algorithm | |
CN117093012B (zh) | 一种面向海洋环境改进a*算法的水下机器人路径规划方法 |
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 | ||
RJ01 | Rejection of invention patent application after publication |
Application publication date: 20220412 |