CN108536140B - 一种无人船自主导航系统及方法 - Google Patents
一种无人船自主导航系统及方法 Download PDFInfo
- Publication number
- CN108536140B CN108536140B CN201810160232.1A CN201810160232A CN108536140B CN 108536140 B CN108536140 B CN 108536140B CN 201810160232 A CN201810160232 A CN 201810160232A CN 108536140 B CN108536140 B CN 108536140B
- Authority
- CN
- China
- Prior art keywords
- unmanned ship
- polygon
- concave
- scanning
- scanning area
- 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.)
- Active
Links
- 238000000034 method Methods 0.000 title claims abstract description 33
- 238000012544 monitoring process Methods 0.000 claims abstract description 17
- 238000013507 mapping Methods 0.000 claims abstract description 16
- 238000001514 detection method Methods 0.000 claims description 5
- 238000005516 engineering process Methods 0.000 description 5
- 238000011161 development Methods 0.000 description 3
- 238000012545 processing Methods 0.000 description 3
- 238000011160 research Methods 0.000 description 3
- XLYOFNOQVPJJNP-UHFFFAOYSA-N water Substances O XLYOFNOQVPJJNP-UHFFFAOYSA-N 0.000 description 3
- 238000004891 communication Methods 0.000 description 2
- 238000010586 diagram Methods 0.000 description 2
- 230000000694 effects Effects 0.000 description 2
- 230000010354 integration Effects 0.000 description 2
- 238000005259 measurement Methods 0.000 description 2
- 238000012876 topography Methods 0.000 description 2
- 238000009825 accumulation Methods 0.000 description 1
- 238000013473 artificial intelligence Methods 0.000 description 1
- 230000009286 beneficial effect Effects 0.000 description 1
- 238000011156 evaluation Methods 0.000 description 1
- 238000003384 imaging method Methods 0.000 description 1
- 230000000977 initiatory effect Effects 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
- 239000013049 sediment Substances 0.000 description 1
- 238000012800 visualization Methods 0.000 description 1
- 239000003643 water by type Substances 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/02—Control of position or course in two dimensions
- G05D1/0206—Control of position or course in two dimensions specially adapted to water vehicles
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)
- Control Of Position, Course, Altitude, Or Attitude Of Moving Bodies (AREA)
Abstract
本发明公开了一种无人船自主导航系统及方法,包括:A、规划无人船自主行驶和扫描测绘的航段路径;B、获取规划的航段路径,控制无人船沿规划的航段路径自主行驶和扫描测绘;C、实时监测无人船当前行驶状态是否偏离规划的航段路径,若发生偏离,则发送指令调整无人船行驶到规划的航段路径,否则保持当前行驶状态不变;D、判断无人船行驶的当前直线航段与下一目标直线航段是否存在大角度弯道,若不存在,则返回步骤C;若存在,则开启转向策略,控制船体以一定转向半径进行转向,以平滑度过弯道,重复执行步骤C,直至无人船完成所有直线航段的扫描测绘。本发明通过如上方法,实现了无人船的自主航行,提高了无人船测绘工作的效率和准确度。
Description
技术领域
本发明属于无人船控制技术领域,特别是涉及一种无人船自主导航系统及方法。
背景技术
海底地形地貌是一切海洋开发和利用活动的基础,其信息获取是海洋测绘中最基础的工作。近年来,随着卫星导航定位、声学探测、数据通讯、计算机数据处理与可视化、图像学和图形学以及现代测量数据处理理论和方法等相关领域的发展,我国的海底地形地貌信息获取技术正在向高精度、高分辨率、自主集成、综合化和标准化方向发展。
无人船是一种新型的水上监测平台,其中以河川、湖泊、水库、海岸及港湾等水域为对象,以小型船舶为载体,集成定位导航、通讯与控制设备,可搭载多种监测传感器,以遥控/自主的工作方式完成特定的水文和水环境要素监测。由于无人船具有布置灵活、成本经济、自动测量等特点,在水文要素观测、水环境监测、水库及河道泥沙淤积量评估、水利工程选址和水下考古等方面具有广阔的应用前景。随着科学技术的发展,对无人船的应用研究越来越广泛,路径规划技术和自主导航技术是有关无人船研究的关键问题,也是无人船人工智能研究的重要内容,在一定程度上标志着无人船智能水平的高低。无人船需要在复杂的海洋环境中自主航行和作业,因此无人船对操纵性、控制性能和可靠性均提出了更为苛刻的要求。为了保证无人船安全、可靠、自主地完成各种复杂任务,这就需要研究更加先进的路径规划、自主导航控制等技术。
发明内容
为了实现无人船能够根据规划好的航段路径进行自主导航,完全实现自主航行,进一步提高无人船测绘工作的效率和工作准确度,本发明提出了一种无人船自主导航系统及方法。
为实现上述目的,本发明采用如下技术方案:一种无人船自主导航方法,所述方法包括如下步骤:
A、规划无人船进行自主行驶和扫描测绘的航段路径;
B、获取规划的航段路径,控制无人船沿所述规划的航段路径自主行驶和扫描测绘;
C、实时监测无人船当前行驶状态是否偏离规划的航段路径,若发生偏离,则发送指令调整无人船行驶到规划的航段路径,否则保持当前行驶状态不变;
D、判断无人船行驶的当前直线航段与下一目标直线航段是否存在大角度弯道,若不存在,则返回步骤C;若存在,则开启转向策略,控制船体以一定转向半径进行转向,以平滑度过弯道,重复执行步骤C,直至无人船完成所有直线航段的扫描测绘。
进一步的,所述步骤A包括:
A1、获取APP地图,并获取用户在APP地图上根据待测区域任意选择的多个点,以多个点为顶点自动生成任意形状的闭合多边形扫描区域;
A2、求取多边形扫描区域的最小外接矩形;
A3、获取用户根据无人船的最大扫描范围设定的扫描线间隔,以及获取用户根据多边形扫描区域的形状设定的扫描线角度,根据获取的扫描线间隔和角度在矩形边上等间隔取点生成扫描线,并以一定距离沿扫描线取航迹点,获得若干航迹点,将相邻两航迹点分别相连生成各直线航段,得到最终规划的航段路径。
进一步的,所述判断无人船行驶的当前直线航段与下一目标直线航段是否存在大角度弯道的具体方法为:根据设定的斜率相差参考值,检测当前直线航段与下一目标直线航段的斜率相差是否达到该设定值,若达到该设定值,则判断为存在大角度弯道。
进一步的,所述开启转向策略的具体方法为:根据当前直线航段与下一目标直线航段,计算船体的转弯点和转向半径,当船体行驶到计算的转弯点时,控制船体以计算的转向半径进行转向,以平滑度过弯道。
进一步的,所述步骤A1中,生成的多边形扫描区域为凸边形或凹边形,所述凹边形包括至少一个凹点。
进一步的,在执行步骤A2前,还执行如下步骤:
A11、判断所述多边形扫描区域为凸边形还是凹边形,若为凸边形,或者为凹边形,且所述凹边形具有一个或两个凹点时,则执行步骤A2;若为凹边形,且所述凹边形具有三个或三个以上凹点时,则执行如下步骤A111;
A111、通过多边形扫描区域顶点间构成的直线斜率差判断凹点,并通过遍历算法选择连接凹点,将该多边形扫描区域转化为若干个子多边形扫描区域,然后判断每个子多边形扫描区域所剩的凹点数,直到每个子多边形扫描区域最多具有一个或两个凹点,然后分别对每个子多边形扫描区域执行步骤A2。
进一步的,在所述步骤A3中,当所述多边形扫描区域为凹边形时,对所述设定的扫描线角度不作具体限定,只需扫描线与所述多边形扫描区域的多个边不存在交点即可。
本发明还提供了一种无人船自主导航系统,所述系统包括:
路径规划模块:用于规划无人船进行自主行驶和扫描测绘的航段路径,并将规划好的航段路径上传给自主导航模块;
自主导航模块:用于获取规划的航段路径,控制无人船沿所述规划的航段路径自主行驶和扫描测绘;
偏航监测模块:用于实时监测无人船当前行驶状态是否偏离规划的航段路径,若发生偏离,则发送指令调整无人船行驶到规划的航段路径,否则保持当前行驶状态不变;
转向控制模块:判断无人船行驶的当前直线航段与下一目标直线航段是否存在大角度弯道,若存在,则开启转向策略,控制船体以一定转向半径进行转向,以平滑度过弯道。
进一步的,所述偏航监测模块包括:
状态检测单元,用于实时检测无人船当前位置坐标和航向;
偏航判断单元,用于根据检测到的无人船当前位置坐标和航向,判断其是否偏离规划的航段路径,若发生偏离,则发送指令调整无人船行驶到规划的航段路径,否则保持当前行驶状态不变。
进一步的,所述转向控制模块包括:
弯道判断单元:用于为判断无人船行驶的当前直线航段与下一目标直线航段是否存在大角度弯道设定一斜率相差参考值,以及根据设定的斜率相差参考值,检测当前直线航段与下一目标直线航段的斜率相差是否达到该设定值,若达到该设定值,则判断为存在大角度弯道;
转向控制单元:用于根据当前直线航段与下一目标直线航段,计算船体的转弯点和转向半径,当船体行驶到计算的转弯点时,控制船体以计算的转向半径进行转向,以平滑度过弯道。
本发明采用如上技术方案带来的有益技术效果是:根据本发明技术方案,实现了一种全自动的无人船路径规划方法,同时,本发明还根据规划好的航段路径,精确的进行自主导航,完全实现了无人船的自主航行,并进一步提高了无人船测绘工作的效率和工作准确度。
附图说明
为了更清楚地说明本发明所述实施例,下面将对实施例所需要使用的附图作简单介绍,显而易见地,下面描述中的附图仅仅是本发明的一些实施例,对于本领域普通技术人员来讲,在不付出创造性劳动的前提下,还可以根据这些附图获得其它的附图。
图1是本发明一个实施例提供的无人船自主导航的方法流程示意图;
图2是本发明一个实施例提供的规划无人船航段路径的方法流程示意图;
图3是本发明一个实施例提供的判断是否存在大角度弯道方法流程示意图;
图4是本发明一个实施例提供的开启转向策略的方法流程示意图;
图5是本发明一个实施例提供的对凹边形扫描区域进行处理的方法流程示意图;
图6是本发明一个实施例提供的生成多边形扫描区域示意图;
图7是本发明一个实施例提供的求取多边形扫描区域最小外接矩形示意图;
图8是本发明一个实施例提供的无人船对点航行示意图;
图9是本发明一个实施例提供的无人船转向策略示意图。
具体实施方式
下面结合附图和实施例对本发明进行详细描述,本文通过参考附图描述的实施例是示例性的,旨在用于解释本发明,而不能理解为对本发明的限制,即所描述的实施例是本发明的一部分实施例,而不是全部的实施例,在不冲突的情况下,本申请中的实施例及实施例中的特征可以相互组合。
实施例1
如图1所示,本发明提供的一种无人船自主导航方法,所述方法包括如下步骤:
A、规划无人船进行自主行驶和扫描测绘的航段路径;
B、获取规划的航段路径,控制无人船沿所述规划的航段路径自主行驶和扫描测绘;
C、实时监测无人船当前行驶状态是否偏离规划的航段路径,若发生偏离,则发送指令调整无人船行驶到规划的航段路径,否则保持当前行驶状态不变;
D、判断无人船行驶的当前直线航段与下一目标直线航段是否存在大角度弯道,若不存在,则返回步骤C;若存在,则开启转向策略,控制船体以一定转向半径进行转向,以平滑度过弯道,重复执行步骤C,直至无人船完成所有直线航段的扫描测绘。
在一个优选实施例中,如图2所示,所述步骤A包括:
A1、获取APP地图,并获取用户在APP地图上根据待测区域任意选择的多个点,以多个点为顶点自动生成任意形状的闭合多边形扫描区域,所述多个点至少为3个点;
A2、求取多边形扫描区域的最小外接矩形;
A3、获取用户根据无人船的最大扫描范围设定的扫描线间隔,以及获取用户根据多边形扫描区域的形状设定的扫描线角度,根据获取的扫描线间隔和角度在矩形边上等间隔取点生成扫描线,并以一定距离沿扫描线取航迹点,获得若干航迹点,将相邻两航迹点分别相连生成各直线航段,得到最终规划的航段路径。
在一个优选实施例中,判断无人船当前行驶状态是否偏离规划的航段路径的具体方法为:
实时检测无人船当前位置坐标和航向,通过磁力计检测或计算得出;
根据检测到的无人船当前位置坐标和航向,判断其是否偏离规划的航段路径,若发生偏离,则发送指令调整无人船行驶到规划的航段路径,否则保持当前行驶状态不变。
在一个优选实施例中,如图3所示,所述判断无人船行驶的当前直线航段与下一目标直线航段是否存在大角度弯道的具体方法为:根据设定的斜率相差参考值,检测当前直线航段与下一目标直线航段的斜率相差是否达到该设定值,若达到该设定值,则判断为存在大角度弯道。
在一个优选实施例中,如图4所示,所述开启转向策略的具体方法为:根据当前直线航段与下一目标直线航段,计算船体的转弯点和转向半径,当船体行驶到计算的转弯点时,控制船体以计算的转向半径进行转向,以平滑度过弯道。
在一个优选实施例中,所述步骤A1中,生成的多边形扫描区域为凸边形或凹边形,所述凹边形包括至少一个凹点。
在一个优选实施例中,如图5所示,在执行步骤A2前,还执行如下步骤:
A11、判断所述多边形扫描区域为凸边形还是凹边形,若为凸边形,或者为凹边形,且所述凹边形具有一个或两个凹点时,则执行步骤A2;若为凹边形,且所述凹边形具有三个或三个以上凹点时,则执行如下步骤A111;
A111、通过多边形扫描区域顶点间构成的直线斜率差判断凹点,并通过遍历算法选择连接凹点,将该多边形扫描区域转化为若干个子多边形扫描区域,然后判断每个子多边形扫描区域所剩的凹点数,直到每个子多边形扫描区域最多具有一个或两个凹点,然后分别对每个子多边形扫描区域执行步骤A2。
在一个优选实施例中,在所述步骤A3中,当所述多边形扫描区域为凹边形时,对所述设定的扫描线角度不作具体限定,只需扫描线与所述多边形扫描区域的多个边不存在交点即可。
示例性的,为了更清楚的描述本发明中规划无人船航段路径的具体方法,详见图6~图7所示,采用如下步骤:
步骤A1、绘制扫描区域:用户在APP地图上根据待测区域任意选择点A~E点,系统以A~E为顶点生成闭合的多边形扫描区域ABCDE,如图6所示,生成的闭合多边形扫描区域为凸边形(根据待测区域的不同,有时会生成包括一个或多个凹点的凹边形)。
A11、判断所述多边形扫描区域为凸边形还是凹边形,若为凸边形,或者为凹边形,且所述凹边形具有一个或两个凹点时,则执行步骤A2;若为凹边形,且所述凹边形具有三个或三个以上凹点时,则执行如下步骤A111;
A111、通过多边形扫描区域顶点间构成的直线斜率差判断凹点,并通过遍历算法选择连接凹点,将该多边形扫描区域转化为若干个子多边形扫描区域,然后判断每个子多边形扫描区域所剩的凹点数,直到每个子多边形扫描区域最多具有一个或两个凹点,然后分别对每个子多边形扫描区域执行步骤A2。
步骤A2、求最小外接矩形:系统软件自动求取多边形ABCDE的最小外接矩形,如图7所示。
步骤A3、用户设定扫描线间隔(根据船的最大扫描范围)和角度,系统程序根据扫描线间隔和角度在矩形边上等间隔取点生成扫描线,然后以一定距离沿扫描线取航迹点,从而获得若干航迹点,将相邻两航迹点分别相连生成各直线航段,得到最终规划的航段路径,所述无人船沿规划的航段路径自主行驶和扫描测绘。
在执行上述步骤A3中,当所述多边形扫描区域为凹边形时,对所述设定的扫描线角度不作具体限定,只需扫描线与所述多边形扫描区域的多个边不存在交点即可。对于有一个或两个凹点的凹边形,可以通过调整扫描路径的角度获得合适的扫描路径,避免出现一条扫描线与多个边有交点的情况。
示例性的,为了更清楚的描述本发明设计的无人船自主导航方法,详见图8、图9所示,
首先,获取规划的航段路径,规划的航段路径将航迹划分为若干个航迹点,无人船的任务即分解为从当前位置到达目标航点,沿所述规划的航段路径自主行驶和扫描测绘。如图8所示,其中船体当前航向为α,通过磁力计检测计算得出,而船当前位置与目标航点连线角度为β。要调整船体当前的航向与目标航向一致,然后控制船运动到目标航点设定半径范围内。即实时监测无人船当前行驶状态是否偏离了规划的航段路径,若发生偏离,则系统发送指令调整无人船行驶到规划的航段路径,否则保持当前行驶状态不变,实现无人船对点航行。
进一步,为实现船体追踪大角度变化航迹时平滑转向行驶,本发明制定了如下转向策略,如图9所示,A为船体当前位置,B和C为连续两个目标航点,当检测到直线AB和直线BC斜率相差达到设定值时,判断为大角度弯道,开启转向策略,当船体行驶到距B点一定距离的P1位置时,根据C的位置以一定转向半径进行转向,以平滑度过弯道。即本发明系统设定一斜率相差参考值,通过计算当前直线航段AB与下一目标直线航段BC的斜率相差,并判断当前直线航段AB与下一目标直线航段BC的斜率相差是否达到该设定值,若达到该设定值,则判断为存在大角度弯道,开启转向策略,系统根据当前直线航段AB与下一目标直线航段BC,计算船体的转弯点和转向半径,控制船体行驶到计算的转弯点P1位置时,再控制船体以计算的转向半径进行转向,以使无人船平滑度过弯道。
实施例2
本发明提供的一种无人船自主导航系统,主要包括:
路径规划模块:用于规划无人船进行自主行驶和扫描测绘的航段路径,并将规划好的航段路径上传给自主导航模块。
自主导航模块:用于获取规划的航段路径,控制无人船沿所述规划的航段路径自主行驶和扫描测绘。
偏航监测模块:用于实时监测无人船当前行驶状态是否偏离规划的航段路径,若发生偏离,则发送指令调整无人船行驶到规划的航段路径,否则保持当前行驶状态不变。
转向控制模块:判断无人船行驶的当前直线航段与下一目标直线航段是否存在大角度弯道,若存在,则开启转向策略,控制船体以一定转向半径进行转向,以平滑度过弯道。
在一个优选实施例中,所述偏航监测模块包括:
状态检测单元,用于实时检测无人船当前位置坐标和航向。
偏航判断单元,用于根据检测到的无人船当前位置坐标和航向,判断其是否偏离规划的航段路径,若发生偏离,则发送指令调整无人船行驶到规划的航段路径,否则保持当前行驶状态不变。
在一个优选实施例中,所述转向控制模块包括:
弯道判断单元:用于为判断无人船行驶的当前直线航段与下一目标直线航段是否存在大角度弯道设定一斜率相差参考值,以及根据设定的斜率相差参考值,检测当前直线航段与下一目标直线航段的斜率相差是否达到该设定值,若达到该设定值,则判断为存在大角度弯道。
转向控制单元:用于根据当前直线航段与下一目标直线航段,计算船体的转弯点和转向半径,当船体行驶到计算的转弯点时,控制船体以计算的转向半径进行转向,以平滑度过弯道。
通过以上的实施方式的描述,本发明中使用的“模块”、“系统”等术语旨在包括与计算机相关的实体,例如但不限于硬件、固件、软硬件组合、软件或者执行中的软件,即本领域的普通技术人员可以清楚地了解到部分实施方式可借助软件加必需的通用硬件平台的方式来实现,当然也可以通过硬件。基于这样的理解,上述技术方案本质上或者说对现有技术做出贡献的部分是以硬件加计算机软件产品的形式体现出来的,该计算机软件产品可以存储在计算机可读存储介质中,如ROM/RAM、磁碟、光盘等,包括若干指令用以使得一台计算机设备(可以是个人计算机,服务器,或者网络设备等)执行各个实施例或者实施例的某些部分所述的方法。最后需要说明的是,以上所述实施例仅用以说明本发明的技术方案,而并非对其限制。尽管参照前述实施例对本发明进行了详细的说明,本领域的普通技术人员应当能够理解,其依然可以对前述各实施例所记载的技术方案进行修改,或者对其中部分技术特征进行等同替换,而这些修改或者替换,并不使相应技术方案的本质脱离本发明各实施例技术方案的精神和范围。
Claims (8)
1.一种无人船自主导航方法,其特征在于,所述方法包括如下步骤:
A、规划无人船进行自主行驶和扫描测绘的航段路径;
B、获取规划的航段路径,控制无人船沿所述规划的航段路径自主行驶和扫描测绘;
C、实时监测无人船当前行驶状态是否偏离规划的航段路径,若发生偏离,则发送指令调整无人船行驶到规划的航段路径,否则保持当前行驶状态不变;
D、判断无人船行驶的当前直线航段与下一目标直线航段是否存在大角度弯道,若不存在,则返回步骤C;若存在,则开启转向策略,控制船体以一定转向半径进行转向,以平滑度过弯道,重复执行步骤C,直至无人船完成所有直线航段的扫描测绘;
所述步骤A包括:
A1、获取电子地图,并获取用户在电子地图上根据待测区域选择的多个点,以多个点为顶点自动生成任意形状的闭合多边形扫描区域;
A2、求取多边形扫描区域的最小外接矩形;
A3、获取用户根据无人船的最大扫描范围设定的扫描线间隔,以及获取用户根据多边形扫描区域的形状设定的扫描线角度,根据获取的扫描线间隔和角度在矩形边上等间隔取点生成扫描线,并以一定距离沿扫描线取航迹点,获得若干航迹点,将相邻两航迹点分别相连生成各直线航段,得到最终规划的航段路径,
其中,在执行步骤A2前,还执行如下步骤:
A11、判断所述多边形扫描区域为凸边形还是凹边形,若为凸边形,或者为凹边形,且所述凹边形具有一个或两个凹点时,则执行步骤A2;若为凹边形,且所述凹边形具有三个或三个以上凹点时,则执行如下步骤A111;
A111、通过多边形扫描区域顶点间构成的直线斜率差判断凹点,并通过遍历算法选择连接凹点,将该多边形扫描区域转化为若干个子多边形扫描区域,然后判断每个子多边形扫描区域所剩的凹点数,直到每个子多边形扫描区域最多具有一个或两个凹点,然后分别对每个子多边形扫描区域执行步骤A2。
2.根据权利要求1所述的无人船自主导航方法,其特征在于:所述判断无人船行驶的当前直线航段与下一目标直线航段是否存在大角度弯道的具体方法为:根据设定的斜率相差参考值,检测当前直线航段与下一目标直线航段的斜率相差是否达到该设定值,若达到该设定值,则判断为存在大角度弯道。
3.根据权利要求1所述的无人船自主导航方法,其特征在于:所述开启转向策略的具体方法为:根据当前直线航段与下一目标直线航段,计算船体的转弯点和转向半径,当船体行驶到计算的转弯点时,控制船体以计算的转向半径进行转向,以平滑度过弯道。
4.根据权利要求2所述的无人船自主导航方法,其特征在于:所述步骤A1中,生成的多边形扫描区域为凸边形或凹边形,所述凹边形包括至少一个凹点。
5.根据权利要求1所述的无人船自主导航方法,其特征在于:在所述步骤A3中,当所述多边形扫描区域为凹边形时,对所述设定的扫描线角度不作具体限定,只需扫描线与所述多边形扫描区域的多个边不存在交点即可。
6.一种无人船自主导航系统,其特征在于:所述系统包括:
路径规划模块:用于规划无人船进行自主行驶和扫描测绘的航段路径,并将规划好的航段路径上传给自主导航模块;所述路径规划模块配置为:获取电子地图,并获取用户在电子地图上根据待测区域选择的多个点,以多个点为顶点自动生成任意形状的闭合多边形扫描区域;求取多边形扫描区域的最小外接矩形;获取用户根据无人船的最大扫描范围设定的扫描线间隔,以及获取用户根据多边形扫描区域的形状设定的扫描线角度,根据获取的扫描线间隔和角度在矩形边上等间隔取点生成扫描线,并以一定距离沿扫描线取航迹点,获得若干航迹点,将相邻两航迹点分别相连生成各直线航段,得到最终规划的航段路径;
自主导航模块:用于获取规划的航段路径,控制无人船沿所述规划的航段路径自主行驶和扫描测绘;
偏航监测模块:用于实时监测无人船当前行驶状态是否偏离规划的航段路径,若发生偏离,则发送指令调整无人船行驶到规划的航段路径,否则保持当前行驶状态不变;
转向控制模块:判断无人船行驶的当前直线航段与下一目标直线航段是否存在大角度弯道,若存在,则开启转向策略,控制船体以一定转向半径进行转向,以平滑度过弯道,
其中,所述路径规划模块还配置为:判断所述多边形扫描区域为凸边形还是凹边形,若为凸边形,或者为凹边形,且所述凹边形具有一个或两个凹点时,则求取多边形扫描区域的最小外接矩形;若为凹边形,且所述凹边形具有三个或三个以上凹点时,则通过多边形扫描区域顶点间构成的直线斜率差判断凹点,并通过遍历算法选择连接凹点,将该多边形扫描区域转化为若干个子多边形扫描区域,然后判断每个子多边形扫描区域所剩的凹点数,直到每个子多边形扫描区域最多具有一个或两个凹点,然后分别对每个子多边形扫描区域执行求最小外接矩形。
7.根据权利要求6所述的无人船自主导航系统,其特征在于,所述偏航监测模块包括:
状态检测单元,用于实时检测无人船当前位置坐标和航向;
偏航判断单元,用于根据检测到的无人船当前位置坐标和航向,判断其是否偏离规划的航段路径,若发生偏离,则发送指令调整无人船行驶到规划的航段路径,否则保持当前行驶状态不变。
8.根据权利要求6所述的无人船自主导航系统,其特征在于,
所述转向控制模块包括:
弯道判断单元:用于为判断无人船行驶的当前直线航段与下一目标直线航段是否存在大角度弯道设定一斜率相差参考值,以及根据设定的斜率相差参考值,检测当前直线航段与下一目标直线航段的斜率相差是否达到该设定值,若达到该设定值,则判断为存在大角度弯道;
转向控制单元:用于根据当前直线航段与下一目标直线航段,计算船体的转弯点和转向半径,当船体行驶到计算的转弯点时,控制船体以计算的转向半径进行转向,以平滑度过弯道。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810160232.1A CN108536140B (zh) | 2018-02-26 | 2018-02-26 | 一种无人船自主导航系统及方法 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN201810160232.1A CN108536140B (zh) | 2018-02-26 | 2018-02-26 | 一种无人船自主导航系统及方法 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN108536140A CN108536140A (zh) | 2018-09-14 |
CN108536140B true CN108536140B (zh) | 2022-03-25 |
Family
ID=63485790
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN201810160232.1A Active CN108536140B (zh) | 2018-02-26 | 2018-02-26 | 一种无人船自主导航系统及方法 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN108536140B (zh) |
Families Citing this family (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN109960256A (zh) * | 2018-10-24 | 2019-07-02 | 大连永航科技有限公司 | 基于面部识别预警的自动导航系统 |
CN109612454A (zh) * | 2018-12-03 | 2019-04-12 | 华东师范大学 | 无人船测绘路径校准方法、系统及无人船 |
CN109631857B (zh) * | 2019-01-28 | 2020-06-05 | 上海大学 | 一种多无人艇联合岛礁测绘系统和方法 |
CN109883317B (zh) * | 2019-03-06 | 2020-10-13 | 株洲太昌电子信息技术股份有限公司 | 一种基于卫星定位的铁路弯道测绘方法 |
CN109945888B (zh) * | 2019-03-11 | 2021-03-16 | 百度在线网络技术(北京)有限公司 | 导航引导线的生成方法、装置及计算机设备 |
CN110136221B (zh) * | 2019-04-12 | 2023-04-11 | 阿波罗智联(北京)科技有限公司 | 用于导航图层绘制的预处理方法及装置 |
CN111460623B (zh) * | 2020-03-06 | 2023-07-14 | 浙江吉翱空间规划科技有限公司 | 一种测绘作业数据实时采集处理方法及系统 |
CN111964683B (zh) * | 2020-08-21 | 2022-11-22 | 苏州极目机器人科技有限公司 | 喷洒路径规划方法和装置 |
CN112445237A (zh) * | 2020-11-16 | 2021-03-05 | 广东电网有限责任公司肇庆供电局 | 无人机巡检地面站系统 |
CN112362067B (zh) * | 2020-11-25 | 2022-09-30 | 江苏恒澄交科信息科技股份有限公司 | 一种用于内河智能船舶的自主航线规划方法 |
Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103149939A (zh) * | 2013-02-26 | 2013-06-12 | 北京航空航天大学 | 一种基于视觉的无人机动态目标跟踪与定位方法 |
CN103512581A (zh) * | 2012-06-28 | 2014-01-15 | 北京搜狗科技发展有限公司 | 一种路径规划方法和装置 |
KR20140145033A (ko) * | 2013-06-12 | 2014-12-22 | 건국대학교 산학협력단 | 탐색 알고리즘을 이용한 미지 환경에서의 경로 매핑 및 영역 탐색방법 |
CN105129064A (zh) * | 2015-09-09 | 2015-12-09 | 广州睿航电子科技有限公司 | 一种无人船巡航控制方法及系统 |
CN105159296A (zh) * | 2015-09-09 | 2015-12-16 | 广州睿航电子科技有限公司 | 一种无人船抗风浪巡航控制方法及系统 |
CN105629989A (zh) * | 2015-12-28 | 2016-06-01 | 电子科技大学 | 基于最小外包圆和最大内接圆的障碍区域划分方法 |
CN106846926A (zh) * | 2017-04-13 | 2017-06-13 | 电子科技大学 | 一种禁飞区无人机预警方法 |
CN107450586A (zh) * | 2017-09-15 | 2017-12-08 | 广州杰赛科技股份有限公司 | 航路的调整方法和系统以及无人机系统 |
CN107517250A (zh) * | 2017-08-14 | 2017-12-26 | 苏州马尔萨斯文化传媒有限公司 | 一种基于无人船的智能航速管理方法及其系统 |
Family Cites Families (10)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
JP3237898B2 (ja) * | 1992-05-29 | 2001-12-10 | 株式会社東芝 | 画像図形編集装置および画像図形編集装置の処理方法 |
US20060106534A1 (en) * | 2002-10-22 | 2006-05-18 | Yukihiro Kawamata | Map data delivering method for communication-type navigation system |
CN101660921A (zh) * | 2009-09-08 | 2010-03-03 | 深圳市戴文科技有限公司 | 路径导航、生成备用路径的方法及系统 |
CN102313547B (zh) * | 2011-05-26 | 2013-02-13 | 东南大学 | 基于手绘轮廓语义地图的移动机器人视觉导航方法 |
CN103400392B (zh) * | 2013-08-19 | 2016-06-22 | 山东鲁能智能技术有限公司 | 基于变电站巡检机器人的双目视觉导航系统及方法 |
CN103886285B (zh) * | 2014-03-11 | 2017-06-09 | 武汉大学 | 先验地理信息辅助下的光学遥感影像舰船检测方法 |
JP6382688B2 (ja) * | 2014-11-06 | 2018-08-29 | 日立建機株式会社 | 地図生成装置 |
CN106125762B (zh) * | 2016-08-01 | 2019-11-12 | 北京艾森博航空科技股份有限公司 | 基于互联网的无人机植保管理系统和方法 |
CN106289264A (zh) * | 2016-08-26 | 2017-01-04 | 哈尔滨工业大学深圳研究生院 | 一种基于子区域划分的多无人机遍历搜索算法 |
CN106845710A (zh) * | 2017-01-18 | 2017-06-13 | 北京艾森博航空科技股份有限公司 | 任务区自动分割方法及系统、航线规划方法及系统 |
-
2018
- 2018-02-26 CN CN201810160232.1A patent/CN108536140B/zh active Active
Patent Citations (9)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN103512581A (zh) * | 2012-06-28 | 2014-01-15 | 北京搜狗科技发展有限公司 | 一种路径规划方法和装置 |
CN103149939A (zh) * | 2013-02-26 | 2013-06-12 | 北京航空航天大学 | 一种基于视觉的无人机动态目标跟踪与定位方法 |
KR20140145033A (ko) * | 2013-06-12 | 2014-12-22 | 건국대학교 산학협력단 | 탐색 알고리즘을 이용한 미지 환경에서의 경로 매핑 및 영역 탐색방법 |
CN105129064A (zh) * | 2015-09-09 | 2015-12-09 | 广州睿航电子科技有限公司 | 一种无人船巡航控制方法及系统 |
CN105159296A (zh) * | 2015-09-09 | 2015-12-16 | 广州睿航电子科技有限公司 | 一种无人船抗风浪巡航控制方法及系统 |
CN105629989A (zh) * | 2015-12-28 | 2016-06-01 | 电子科技大学 | 基于最小外包圆和最大内接圆的障碍区域划分方法 |
CN106846926A (zh) * | 2017-04-13 | 2017-06-13 | 电子科技大学 | 一种禁飞区无人机预警方法 |
CN107517250A (zh) * | 2017-08-14 | 2017-12-26 | 苏州马尔萨斯文化传媒有限公司 | 一种基于无人船的智能航速管理方法及其系统 |
CN107450586A (zh) * | 2017-09-15 | 2017-12-08 | 广州杰赛科技股份有限公司 | 航路的调整方法和系统以及无人机系统 |
Also Published As
Publication number | Publication date |
---|---|
CN108536140A (zh) | 2018-09-14 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN108536140B (zh) | 一种无人船自主导航系统及方法 | |
Song et al. | Smoothed A* algorithm for practical unmanned surface vehicle path planning | |
Candeloro et al. | A Voronoi-diagram-based dynamic path-planning system for underactuated marine vessels | |
Specht et al. | Application of an autonomous/unmanned survey vessel (ASV/USV) in bathymetric measurements | |
Larson et al. | Advances in autonomous obstacle avoidance for unmanned surface vehicles | |
CN109000646B (zh) | 基于凹多边形扫描区域的无人船路径规划方法及系统 | |
US20200159227A1 (en) | Method of navigating a vehicle and system thereof | |
Bandyophadyay et al. | A simple reactive obstacle avoidance algorithm and its application in singapore harbor | |
EP3722911B1 (en) | A system and method of planning a path for an autonomous vessel | |
BRPI0918941B1 (pt) | método automatizado para navegação autônoma de uma plataforma manobrável e sistema de navegação autônoma para manobrar uma plataforma manobrável | |
CN104267723A (zh) | 远洋船舶导航自动航行系统及导航方法 | |
Thompson et al. | Efficient lidar-based object segmentation and mapping for maritime environments | |
CN109612454A (zh) | 无人船测绘路径校准方法、系统及无人船 | |
Liu et al. | A practical path planning and navigation algorithm for an unmanned surface vehicle using the fast marching algorithm | |
Fabrice et al. | Interval SLAM for underwater robots; a new experiment | |
JP2020008443A (ja) | 航法装置及びルート作成方法 | |
CN112880678A (zh) | 一种复杂水域环境中无人艇航行规划方法 | |
CN112068565A (zh) | 一种结构化环境中的无人船自主导航方法和系统 | |
CN111412918B (zh) | 无人艇全局安全路径规划方法 | |
Reed et al. | Providing nautical chart awareness to autonomous surface vessel operations | |
Sawada et al. | Mapping and localization for autonomous ship using LiDAR SLAM on the sea | |
CN114061565A (zh) | 一种无人船舶slam及其应用方法 | |
Dunbabin | Autonomous greenhouse gas sampling using multiple robotic boats | |
Horner et al. | AUV experiments in obstacle avoidance | |
Praczyk | Correction of navigational information supplied to biomimetic autonomous underwater vehicle |
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 | ||
CB02 | Change of applicant information |
Address after: 264200 Zone E, blue venture Valley, No. 40, Yangguang Road, Nanhai new area, Weihai City, Shandong Province Applicant after: Zhendi Technology Co.,Ltd. Address before: Unit 301, unit a, 9 Fulin Road, Chaoyang District, Beijing 100107 Applicant before: POWERVISION TECH Inc. |
|
CB02 | Change of applicant information | ||
GR01 | Patent grant | ||
GR01 | Patent grant | ||
PP01 | Preservation of patent right |
Effective date of registration: 20240123 Granted publication date: 20220325 |
|
PP01 | Preservation of patent right |