CN111665868B - 基于虚拟航道的无人船返航方法、装置、设备及存储介质 - Google Patents
基于虚拟航道的无人船返航方法、装置、设备及存储介质 Download PDFInfo
- Publication number
- CN111665868B CN111665868B CN202010702367.3A CN202010702367A CN111665868B CN 111665868 B CN111665868 B CN 111665868B CN 202010702367 A CN202010702367 A CN 202010702367A CN 111665868 B CN111665868 B CN 111665868B
- Authority
- CN
- China
- Prior art keywords
- unmanned ship
- return
- path
- main channel
- coordinate
- 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
Images
Classifications
-
- G—PHYSICS
- G05—CONTROLLING; REGULATING
- G05D—SYSTEMS FOR CONTROLLING OR REGULATING NON-ELECTRIC VARIABLES
- G05D1/00—Control of position, course or altitude of land, water, air, or space vehicles, e.g. automatic pilot
- 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
Abstract
本发明实施例公开了一种基于虚拟航道的无人船返航方法、装置、设备及存储介质。所述方法包括:建立无人船的虚拟主航道;判断所述虚拟主航道的有效性;根据返航指令或预设的返航条件控制无人船返航;使所述无人船从当前位置航行至所述虚拟主航道;计算基于所述虚拟主航道的最短返航路径;将所述最短返航路径设定为无人船的返航路径,所述无人船自主航行实现返航。用户可使用终端设备便捷地设置无人船的虚拟航道,返航时通过动态规划算法,能够根据当前位置和目标返航点自动计算出所需最短的返航路径,使无人船能够实现自主规划返航路径,达到从任意位置自主返航的目的。
Description
技术领域
本发明涉及无人船控制技术领域,尤其涉及一种基于虚拟航道的无人船返航方法、装置、设备及存储介质。
背景技术
无人船是一种机动灵活的水面自主机器人,可作为大型调查船向不易抵达的浅水区的功能延伸,辅助人工作业。目前无人船在浅水区域的作业工作中得到广泛应用。
近年来,无人船的智能化程度日益受到重视,其智能控制系统的性能直接影响无人船的操作性、经济性和安全性,其中良好的自主返航能力尤为重要。现有的无人船自主返航方式主要是通过计算全球定位系统给出的出发位置坐标和目标返航点位置坐标之间的最短直线返航路径进行返航。而在实际场景中,由于河道、湖泊等水域的形状崎岖,水面路线曲折,仅通过坐标定位实现直线返航效率低下,且难以准确返回目标返航点。因此有必要提供一种灵活路径规划的无人船自主返航方法,以克服上述缺点。
公开于该背景技术部分的信息仅仅旨在加深对本发明的总体背景技术的理解,而不应当被视为承认或以任何形式暗示该信息构成已为本领域技术人员所公知的现有技术。
基于上述原因,本申请人提出了一种基于虚拟航道的无人船返航方法、装置、设备及存储介质。
发明内容
本发明实施例提供了一种基于虚拟航道的无人船返航方法、装置、计算机设备及存储介质,旨在解决现有技术中由于河道、湖泊等水域的形状崎岖以及水面路线曲折,仅通过坐标定位实现直线返航效率低下,且难以准确返回目标返航点的问题。
第一方面,本发明实施例提供了一种基于虚拟航道的无人船返航方法,包括以下步骤:建立无人船的虚拟主航道;判断所述虚拟主航道的有效性;根据返航指令或预设的返航条件控制无人船返航;使所述无人船从当前位置航行至所述虚拟主航道;计算基于所述虚拟主航道的最短返航路径;将所述最短返航路径设定为无人船的返航路径,所述无人船自主航行实现返航。
第二方面,本发明实施例还提供了一种基于虚拟航道的无人船返航装置,其包括用于执行上述基于虚拟航道的无人船返航方法的单元。
第三方面,本发明实施例还提供了一种计算机设备,其包括存储器及处理器,所述存储器上存储有计算机程序,所述处理器执行所述计算机程序时实现上述基于虚拟航道的无人船返航方法。
第四方面,本发明实施例还提供了一种计算机可读存储介质,所述存储介质存储有计算机程序,所述计算机程序包括程序指令,所述程序指令当被处理器执行时可实现上述基于虚拟航道的无人船返航方法。
本发明实施例提供了一种基于虚拟航道的无人船返航方法、装置、计算机设备及存储介质。其中,基于虚拟航道的无人船返航方法包括:建立无人船的虚拟主航道;判断所述虚拟主航道的有效性;根据返航指令或预设的返航条件控制无人船返航;使所述无人船从当前位置航行至所述虚拟主航道;计算基于所述虚拟主航道的最短返航路径;将所述最短返航路径设定为无人船的返航路径,所述无人船自主航行实现返航。
本发明实施例由于用户可使用终端设备便捷地设置无人船的虚拟航道,返航时通过动态规划算法,能够根据当前位置和目标返航点自动计算出所需最短的返航路径,使无人船能够实现自主规划返航路径,达到从任意位置自主返航的目的,解决了由于河道、湖泊等水域的形状崎岖以及水面路线曲折,仅通过坐标定位实现直线返航效率低下,且难以准确返回目标返航点的问题。
下面结合附图和具体实施例对本发明作进一步描述。
附图说明
图1是本发明实施例提供的基于虚拟航道的无人船返航方法的流程示意图;
图2是本发明另一实施例提供的基于虚拟航道的无人船返航方法的流程示意图;
图3是本发明实施例提供的基于虚拟航道的无人船返航方法的应用场景示意图;
图4是本发明实施例提供的基于虚拟航道的无人船返航装置的示意性框图;
图5是本发明实施例提供的计算机设备的示意性框图。
具体实施方式
下面将结合本发明实施例中的附图,对本发明实施例中的技术方案进行清楚、完整地描述,显然,所描述的实施例是本发明一部分实施例,而不是全部的实施例。基于本发明中的实施例,本领域普通技术人员在没有做出创造性劳动前提下所获得的所有其他实施例,都属于本发明保护的范围。
应当理解,当在本说明书和所附权利要求书中使用时,术语“包括”和 “包含”指示所描述特征、整体、步骤、操作、元素和/或组件的存在,但并不排除一个或多个其它特征、整体、步骤、操作、元素、组件和/或其集合的存在或添加。
还应当理解,在此本发明说明书中所使用的术语仅仅是出于描述特定实施例的目的而并不意在限制本发明。如在本发明说明书和所附权利要求书中所使用的那样,除非上下文清楚地指明其它情况,否则单数形式的“一”、“一个”及“该”意在包括复数形式。
还应当进一步理解,在本发明说明书和所附权利要求书中使用的术语“和/ 或”是指相关联列出的项中的一个或多个的任何组合以及所有可能组合,并且包括这些组合。
请参阅图1,图1为本发明实施例提供的基于虚拟航道的无人船返航方法的流程示意图。如图1所示,本发明的基于虚拟航道的无人船返航方法,可通过设置虚拟航道或者记录航行目标点,获取无人船坐标信息,通过动态规划算法,根据无人船当前位置和目标返航点自动计算出所需最短的返航路径,相较于传统返航方法,使无人船能够实现对返航路径的自主规划,达到任意位置自主返航的目的。本发明实例提供的返航方法也可单独用于其他返航应用场景,例如其他航行船只甚至是无人车辆导航。
如图1所示,本发明实施例提供的基于虚拟航道的无人船返航方法包括以下步骤:S110-S160。
步骤S110、建立无人船的虚拟主航道;
具体地,在本实施例中,建立虚拟主航道可在无人船下水作业之前以及下水作业过程中,根据无人船获取的地理位置信息进行水域三维模型/电子地图的构建,以便于将本方案的实用性扩展至最大。
在一可能的实施例中,根据来自于终端设备的地图标记请求获取目标点,和/或,根据所述无人船在航行中获取的实时位置得到目标点,将所述目标点依次连接构成路径,组合多条路径构成所述虚拟主航道。
其中,终端设备可包括但不限于手机,电脑、遥控器等。具体地,使用手机,电脑、遥
控器等设备的电子地图上手动标记出目标点,或通过将无人船在航行过程中获取的实施位
置信息存储作为目标点,将目标点依次连接构成路径点队列,,……,,将这些路径组合起来得到初始虚拟主
航道的数组。其中,表示设置路径数量,表示各路径中目标
点的数量,表示每条路径上目标点的坐标信息。
步骤S120、判断所述虚拟主航道的有效性;
在本实施例中,对已设置虚拟主航道进行有效性判断,目的在于保存有效路径,丢弃无效路径。
在一可能的实施例中,本步骤可如图2所示的流程执行:
步骤S121、获取所述虚拟主航道的路径的坐标点并构建坐标数据队列;
步骤S122、对所述坐标数据队列中的路径的坐标点两两遍历计算路径中离散点坐标的最小直线距离;
步骤S123、判断两条路径中是否存在路径的坐标点之间的最小距离小于预设阈值;
若存在,则执行步骤S124、所述两条路径标记为连通路径并保存至虚拟主航道的坐标数据队列;若不存在,则舍弃坐标,结束这一流程(其逻辑关系为:若存在某条路径的所有坐标点与任一路径的坐标点之间的最小距离均大于预设阈值,则舍弃该路径的坐标数据)。
步骤S125、开始返航;
步骤S126、根据无人船当前位置规划返航路径;
步骤S127、使所述无人船按照规划好的返航路径进行返航。
直至结束流程。
具体地,对虚拟主航道的数组中路径点坐标构成的坐标数据队列中每条路径两
两遍历计算路径中离散点坐标的最小直线距离,如果两条路径中存在坐标点间的最小距离
小于给定阈值,则认为该两条路径为连通路径,保存在主航道的路径坐标数据队列中;如
果某条路径中所有坐标点与任意一条路径的坐标点间的最小距离均大于给定阈值,则丢弃
该路径的坐标数据队列;
步骤S130、根据返航指令或预设的返航条件控制无人船返航;
本步骤的应用场景可为,当无人船在下水作业时,管理人员需要无人船返航,或无人船检测到自身设备存在隐患时,需要立即返航。
具体地,可通过获取来自于终端设备的返航请求,控制无人船启动返航功能;
或,检测无人船电量、运载量以及自身设备异常信息,若所述无人船满足以下一项或多项则启动返航功能:
所述无人船电量低于设于阈值;
所述运载量高于设于阈值;
所述无人船存在设备异常信息。
其中,上述步骤的实现可依赖以下操作:使用终端发送命令至无人船启动返航,或者无人船根据状态判断需要返航时,启动返航:具体地,使用手机,电脑、遥控器等终端设备进行命令输入操作,发送返航指令,实现返航功能;或者当无人船判断自身电量能够行驶的里程小于等于返航里程时,自动启动返航操作;当无人船检测到垃圾量达到预设阈值,呈现满载状态时,自动启动返航操作;当无人船检测到自身设备异常需要返航时,自动启动返航操作。
步骤S140、使所述无人船从当前位置航行至所述虚拟主航道;
获取所述无人船当前实时位置,根据实时位置计算距离最近的所述虚拟主航道的坐标点,控制所述无人船航行至所述虚拟主航道的坐标点。
在某些实施例中,步骤S140、根据全球定位系统获取无人船当前位置,无人船从当前位置自主航行至已设定的虚拟航道上,通过Floyd算法计算出最短路径,并沿最短路径运动到离目标返航点最近的虚拟航道坐标点,根据最短返航路径,自主控制航行实现返航。
其中,Floyd算法的执行过程为:
1、从任意一条单边路径开始。所有两点之间的距离是边的权,如果两点之间没有边相连,则权为无穷大。在本实施例中,边的权值即为两个坐标点之间的最小距离。
2、对于每一对顶点 u 和 v,判断是否存在一个顶点 w 使得从 u 到 w 再到 v比已知的路径更短,如果是则进行更新。
在其他实施例中,还可采用Prim算法、Dijkstra算法、Kruskal算法等实现获取到达虚拟主航道的最短路径。
步骤S150、计算基于所述虚拟主航道的最短返航路径;
可参考图3,图3为本发明实施例提供的基于虚拟航道的无人船返航方法的应用场
景示意图,具体地,步骤S150的一实施例为:根据全球定位系统获取无人船当前实时位置
,对主航道的路径坐标数据队列中的路径坐标点进行遍历筛选,找出距离无人船当前实
时位置最近的虚拟航道上的坐标,计算行驶路径,并通过当前位置信息和最近虚拟航
道上的坐标位置信息的角度差计算出无人船期望运动方向,使用控制模块控制无人船自主
运动至最近的虚拟航道上的坐标;
进一步地,对坐标数据队列中的路径离散坐标点进行两两遍历计算,生成当前路
径每个坐标点与其它路径坐标点一一对应的对应关系集合。通过设定最小距离阈值对集
合中的对应关系进行筛选,更新关系集合,仅将两点间距离小于给定阈值的坐标点对应
关系保存在映射集合中。将无人船当前实时位置和目标返航位置坐标列入映射集合
中,更新后,形成完整映射集合,涵盖所有有效路径可能性。
具体地,通过Floyd算法计算出到达距离目标返航位置的最短连接,即为从任意一
条单边路径开始,所有两点之间的距离是边的权,如果两点之间没有边相连,则权为无穷
大;对于每一对顶点和,看看是否存在一个顶点使得从到再到比已知的路径更短,
如果有则更新数据。
当时,,其中,就是允许中间点为,,的,从到的路径中的最短路径长度,即是求从到中间可插入任何顶点的路径中最短路径长度,即为迭代后的所得距离矩阵。在中包含有两点之间最短路径的信息,而在中则包含
了最短通路径的信息。根据得到最短路径信息映射出最短路径坐标点队列,进行存储。
具体地,通过起始点和两个路径点,在返回的map之中计算出船要经过的路径
点的最短路径𝑅1的索引值,同时将起始点的索引值和目标返航点的索引值𝑒与之
一起生成路径点索引序列𝑝=[𝑠,,𝑒],将中的节点索引值通过点坐标映射集合转换为返
航路径坐标点集合𝐵=[,,......]。根据无人船当前实时位置,选择路径坐标点
队列中距离无人船当前实时位置最近的点作为实时期望目标点。无人船根据这一系列
坐标点计算出每一个点的期望方向角,通过控制模块控制无人船自主到达该目标点,到达
该目标点后,期望目标点在路径坐标队列中依次向后更新,让无人船始终沿着期望方向角
运动,直到无人船到达路径队列中的末尾坐标点,从而完成基于虚拟航道的自主返航;
步骤S160、将所述最短返航路径设定为无人船的返航路径,所述无人船自主航行实现返航。
具体地,步骤可通过获取所述最短返航路径的坐标点队列,选择所述坐标点队列中距离所述无人船当前实时位置最近的坐标点作为实时期望目标点,控制所述无人船航行至实时期望目标点;
当所述无人船到达实时期望目标点,选择所述坐标点队列中距离所述无人船当前实时位置最近的坐标点作为新的期望目标点,直至所述无人船到达路径目标点的末尾坐标点。
通过上述方法,实现用户可以通过手机、电脑、遥控器等操作点设置虚拟航道,根据无人船的当前位置和目标返航点自主规划返航路径,使无人船沿着虚拟主航道返回到目标返航点,实现任意位置自主规划返航。
图4是本发明实施例提供的一种基于虚拟航道的无人船返航装置的示意性框图。如图4所示,对应于以上基于虚拟航道的无人船返航方法,本发明还公开了一种基于虚拟航道的无人船返航装置200,包括以下单元:
虚拟航道创建单元201,用于建立无人船的虚拟主航道;
虚拟航道检测单元202,用于判断所述虚拟主航道的有效性;
返航功能启动单元203,用于根据返航指令或预设的返航条件控制无人船返航;
船体航行控制单元204,用于使所述无人船从当前位置航行至所述虚拟主航道;
最短路径获取单元205,用于计算基于所述虚拟主航道的最短返航路径;
返航功能执行单元206,用于将所述最短返航路径设定为无人船的返航路径,所述无人船自主航行实现返航。
需要说明的是,所属领域的技术人员可以清楚地了解到,上述基于虚拟航道的无人船返航装置200和各单元的具体实现过程,可以参考前述方法实施例中的相应描述,为了描述的方便和简洁,在此不再赘述。
上述基于虚拟航道的无人船返航装置可以实现为一种计算机程序的形式,该计算机程序可以在如图5所示的计算机设备上运行。
请参阅图5,图5是本申请实施例提供的一种计算机设备的示意性框图。该计算机设备300可以是服务器,其中,服务器可以是独立的服务器,也可以是多个服务器组成的服务器集群。
参阅图5,该计算机设备300包括通过系统总线301连接的处理器302、存储器和网络接口305,其中,存储器可以包括非易失性存储介质303和内存储器304。
该非易失性存储介质303可存储操作系统3031和计算机程序3032。该计算机程序3032包括程序指令,该程序指令被执行时,可使得处理器302执行一种基于虚拟航道的无人船返航方法。
该处理器302用于提供计算和控制能力,以支撑整个计算机设备300的运行。
该内存储器304为非易失性存储介质303中的计算机程序3032的运行提供环境,该计算机程序3032被处理器302执行时,可使得处理器302执行一种基于虚拟航道的无人船返航方法。
该网络接口305用于与其它设备进行网络通信。本领域技术人员可以理解,图5中示出的结构,仅仅是与本申请方案相关的部分结构的框图,并不构成对本申请方案所应用于其上的计算机设备300的限定,具体的计算机设备300可以包括比图中所示更多或更少的部件,或者组合某些部件,或者具有不同的部件布置。
其中,所述处理器302用于运行存储在存储器中的计算机程序3032,以实现如下步骤:
在一实施例中,处理器302实现所述建立无人船的虚拟主航道的步骤;根据来自于终端设备的地图标记请求获取目标点,和/或,根据所述无人船在航行中获取的实时位置得到目标点,将所述目标点依次连接构成路径,组合多条路径构成所述虚拟主航道。
在一实施例中,处理器302实现所述判断所述虚拟主航道的有效性的步骤;获取所述虚拟主航道的路径的坐标点并构建坐标数据队列,对所述坐标数据队列中的路径的坐标点两两遍历计算路径中离散点坐标的最小直线距离;
若两条路径中存在路径的坐标点之间的最小距离小于预设阈值,则将所述两条路径标记为连通路径并保存至虚拟主航道的坐标数据队列;
若存在某条路径的所有坐标点与任一路径的坐标点之间的最小距离均大于预设阈值,则舍弃该路径的坐标数据。
在一实施例中,处理器302实现所述根据返航指令或预设的返航条件控制无人船返航的步骤;获取来自于终端设备的返航请求,控制无人船启动返航功能;检测无人船电量、运载量以及自身设备异常信息,若所述无人船满足以下一项或多项则启动返航功能:所述无人船电量低于设于阈值;所述运载量高于设于阈值;所述无人船存在设备异常信息。
在一实施例中,处理器302实现所述使所述无人船从当前位置航行至所述虚拟主航道的步骤;获取所述无人船当前实时位置,根据实时位置计算距离最近的所述虚拟主航道的坐标点,控制所述无人船航行至所述虚拟主航道的坐标点。
在一实施例中,处理器302实现所述计算基于所述虚拟主航道的最短返航路径的步骤;获取所述虚拟主航道的路径的坐标点并构建坐标数据队列,对所述坐标数据队列中的路径的坐标点两两遍历,获得当前路径的每个坐标点与其它路径的坐标点一一对应的对应关系集合;判断所述对应关系集合中坐标点的距离是否小于最小距离阈值,若小于,则将所述对应关系集合中坐标点保存至映射集合;添加所述无人船的当前实时位置和目标返航位置的坐标至所述映射集合,利用动态规划算法计算所述映射集合中到达目标返航位置的最短连接,得到基于所述虚拟主航道的最短返航路径。
在一实施例中,处理器302实现所述将所述最短返航路径设定为无人船的返航路径,所述无人船自主航行实现返航的步骤。获取所述最短返航路径的坐标点队列,选择所述坐标点队列中距离所述无人船当前实时位置最近的坐标点作为实时期望目标点,控制所述无人船航行至实时期望目标点;当所述无人船到达实时期望目标点,选择所述坐标点队列中距离所述无人船当前实时位置最近的坐标点作为新的期望目标点,直至所述无人船到达路径目标点的末尾坐标点。
应当理解,在本申请实施例中,处理器302可以是中央处理单元 (CentralProcessing Unit,CPU),该处理器302还可以是其他通用处理器、数字信号处理器(Digital Signal Processor,DSP)、专用集成电路 (Application Specific IntegratedCircuit,ASIC)、现成可编程门阵列 (Field-Programmable Gate Array,FPGA) 或者其他可编程逻辑器件、分立门或者晶体管逻辑器件、分立硬件组件等。其中,通用处理器可以是微处理器或者该处理器也可以是任何常规的处理器等。
本领域普通技术人员可以理解的是实现上述实施例的方法中的全部或部分流程,是可以通过计算机程序来指令相关的硬件来完成。该计算机程序包括程序指令,计算机程序可存储于一存储介质中,该存储介质为计算机可读存储介质。该程序指令被该计算机系统中的至少一个处理器执行,以实现上述方法的实施例的流程步骤。因此,本发明还提供一种存储介质。该存储介质可以为计算机可读存储介质。该存储介质存储有计算机程序,其中计算机程序包括程序指令。该程序指令被处理器执行时使处理器执行如下步骤:
在一实施例中,所述处理器执行所述程序指令而实现所述若接收到用户端所发送的登录请求,对所述登录请求中的用户账号进行验证以得到所述用户账号是否验证通过的验证结果;若所述验证结果为所述用户账号验证通过,将所述用户账号作为索引信息,从预设数据库中搜索得到与所述索引信息相匹配的角色;根据所述角色获取所述角色所对应的权限以及与所述权限相对应的操作菜单;将所述权限以及所 述操作菜单反馈至所述用户端以使所述用户端加载所述操作菜单以供用户基于所述权限对所述操作菜单进行操作的步骤:
其中,所述处理器302用于运行存储在存储器中的计算机程序3032,以实现如下步骤:
在一实施例中,所述处理器执行所述程序指令而实现所述建立无人船的虚拟主航道的步骤;根据来自于终端设备的地图标记请求获取目标点,和/或,根据所述无人船在航行中获取的实时位置得到目标点,将所述目标点依次连接构成路径,组合多条路径构成所述虚拟主航道。
在一实施例中,所述处理器执行所述程序指令而实现所述判断所述虚拟主航道的有效性;获取所述虚拟主航道的路径的坐标点并构建坐标数据队列,对所述坐标数据队列中的路径的坐标点两两遍历计算路径中离散点坐标的最小直线距离;若两条路径中存在路径的坐标点之间的最小距离小于预设阈值,则将所述两条路径标记为连通路径并保存至虚拟主航道的坐标数据队列;若存在某条路径的所有坐标点与任一路径的坐标点之间的最小距离均大于预设阈值,则舍弃该路径的坐标数据。
在一实施例中,所述处理器执行所述程序指令而实现所述根据返航指令或预设的返航条件控制无人船返航;获取来自于终端设备的返航请求,控制无人船启动返航功能;检测无人船电量、运载量以及自身设备异常信息,若所述无人船满足以下一项或多项则启动返航功能:所述无人船电量低于设于阈值;所述运载量高于设于阈值;所述无人船存在设备异常信息。
在一实施例中,所述处理器执行所述程序指令而实现所述使所述无人船从当前位置航行至所述虚拟主航道;获取所述无人船当前实时位置,根据实时位置计算距离最近的所述虚拟主航道的坐标点,控制所述无人船航行至所述虚拟主航道的坐标点。
在一实施例中,所述处理器执行所述程序指令而实现所述计算基于所述虚拟主航道的最短返航路径;获取所述虚拟主航道的路径的坐标点并构建坐标数据队列,对所述坐标数据队列中的路径的坐标点两两遍历,获得当前路径的每个坐标点与其它路径的坐标点一一对应的对应关系集合;判断所述对应关系集合中坐标点的距离是否小于最小距离阈值,若小于,则将所述对应关系集合中坐标点保存至映射集合;添加所述无人船的当前实时位置和目标返航位置的坐标至所述映射集合,利用动态规划算法计算所述映射集合中到达目标返航位置的最短连接,得到基于所述虚拟主航道的最短返航路径。
在一实施例中,所述处理器执行所述程序指令而实现所述将所述最短返航路径设定为无人船的返航路径,所述无人船自主航行实现返航。获取所述最短返航路径的坐标点队列,选择所述坐标点队列中距离所述无人船当前实时位置最近的坐标点作为实时期望目标点,控制所述无人船航行至实时期望目标点;当所述无人船到达实时期望目标点,选择所述坐标点队列中距离所述无人船当前实时位置最近的坐标点作为新的期望目标点,直至所述无人船到达路径目标点的末尾坐标点。
所述存储介质可以是U盘、移动硬盘、只读存储器(Read-Only Memory,ROM)、磁碟或者光盘等各种可以存储程序代码的计算机可读存储介质。
本领域普通技术人员可以意识到,结合本文中所公开的实施例描述的各示例的单元及算法步骤,能够以电子硬件、计算机软件或者二者的结合来实现,为了清楚地说明硬件和软件的可互换性,在上述说明中已经按照功能一般性地描述了各示例的组成及步骤。这些功能究竟以硬件还是软件方式来执行,取决于技术方案的特定应用和设计约束条件。专业技术人员可以对每个特定的应用来使用不同方法来实现所描述的功能,但是这种实现不应认为超出本发明的范围。
在本发明所提供的几个实施例中,应该理解到,所揭露的装置和方法,可以通过其它的方式实现。例如,以上所描述的装置实施例仅仅是示意性的。例如,各个单元的划分,仅仅为一种逻辑功能划分,实际实现时可以有另外的划分方式。例如多个单元或组件可以结合或者可以集成到另一个系统,或一些特征可以忽略,或不执行。
本发明实施例方法中的步骤可以根据实际需要进行顺序调整、合并和删减。本发明实施例装置中的单元可以根据实际需要进行合并、划分和删减。另外,在本发明各个实施例中的各功能单元可以集成在一个处理单元中,也可以是各个单元单独物理存在,也可以是两个或两个以上单元集成在一个单元中。
该集成的单元如果以软件功能单元的形式实现并作为独立的产品销售或使用时,可以存储在一个存储介质中。基于这样的理解,本发明的技术方案本质上或者说对现有技术做出贡献的部分,或者该技术方案的全部或部分可以以软件产品的形式体现出来,该计算机软件产品存储在一个存储介质中,包括若干指令用以使得一台计算机设备(可以是个人计算机,终端,或者网络设备等)执行本发明各个实施例所述方法的全部或部分步骤。
以上所述,仅为本发明的具体实施方式,但本发明的保护范围并不局限于此,任何熟悉本技术领域的技术人员在本发明揭露的技术范围内,可轻易想到各种等效的修改或替换,这些修改或替换都应涵盖在本发明的保护范围之内。因此,本发明的保护范围应以权利要求的保护范围为准。
Claims (7)
1.一种基于虚拟航道的无人船返航方法,其特征在于,包括以下步骤:
建立无人船的虚拟主航道;
所述建立无人船的虚拟主航道的步骤包括:根据来自于终端设备的地图标记请求获取目标点,和/或,根据所述无人船在航行中获取的实时位置得到目标点,将所述目标点依次连接构成路径,组合多条路径构成所述虚拟主航道;
判断所述虚拟主航道的有效性;
所述判断所述虚拟主航道的有效性的步骤包括:获取所述虚拟主航道的路径的坐标点并构建坐标数据队列,对所述坐标数据队列中的路径的坐标点两两遍历计算路径中离散点坐标的最小直线距离;若两条路径中存在路径的坐标点之间的最小距离小于预设阈值,则将所述两条路径标记为连通路径并保存至虚拟主航道的坐标数据队列;若存在某条路径的所有坐标点与任一路径的坐标点之间的最小距离均大于预设阈值,则舍弃该路径的坐标数据;
根据返航指令或预设的返航条件控制无人船返航;
使所述无人船从当前位置航行至所述虚拟主航道;
计算基于所述虚拟主航道的最短返航路径;
所述计算基于所述虚拟主航道的最短返航路径的步骤包括:获取所述虚拟主航道的路径的坐标点并构建坐标数据队列,对所述坐标数据队列中的路径的坐标点两两遍历,获得当前路径的每个坐标点与其它路径的坐标点一一对应的对应关系集合;判断所述对应关系集合中坐标点的距离是否小于最小距离阈值,若小于,则将所述对应关系集合中坐标点保存至映射集合;添加所述无人船的当前实时位置和目标返航位置的坐标至所述映射集合,利用动态规划算法计算所述映射集合中到达目标返航位置的最短连接,得到基于所述虚拟主航道的最短返航路径;将所述最短返航路径设定为无人船的返航路径,所述无人船自主航行实现返航。
2.根据权利要求1所述的基于虚拟航道的无人船返航方法,其特征在于,所述根据返航指令或预设的返航条件控制无人船返航的步骤包括:
获取来自于终端设备的返航请求,控制无人船启动返航功能;
检测无人船电量、运载量以及自身设备异常信息,若所述无人船满足以下一项或多项则启动返航功能:
所述无人船电量低于设于阈值;
所述运载量高于设于阈值;
所述无人船存在设备异常信息。
3.根据权利要求1所述的基于虚拟航道的无人船返航方法,其特征在于,所述使所述无人船从当前位置航行至所述虚拟主航道的步骤包括:
获取所述无人船当前实时位置,根据实时位置计算距离最近的所述虚拟主航道的坐标点,控制所述无人船航行至所述虚拟主航道的坐标点。
4.根据权利要求1所述的基于虚拟航道的无人船返航方法,其特征在于,所述将所述最短返航路径设定为无人船的返航路径的步骤包括:
获取所述最短返航路径的坐标点队列,选择所述坐标点队列中距离所述无人船当前实时位置最近的坐标点作为实时期望目标点,控制所述无人船航行至实时期望目标点;
当所述无人船到达实时期望目标点,选择所述坐标点队列中距离所述无人船当前实时位置最近的坐标点作为新的期望目标点,直至所述无人船到达路径目标点的末尾坐标点。
5.一种基于虚拟航道的无人船返航装置,其特征在于,包括以下单元:
虚拟航道创建单元,用于建立无人船的虚拟主航道;
所述建立无人船的虚拟主航道的步骤包括:根据来自于终端设备的地图标记请求获取目标点,和/或,根据所述无人船在航行中获取的实时位置得到目标点,将所述目标点依次连接构成路径,组合多条路径构成所述虚拟主航道;
虚拟航道检测单元,用于判断所述虚拟主航道的有效性;
所述判断所述虚拟主航道的有效性的步骤包括:获取所述虚拟主航道的路径的坐标点并构建坐标数据队列,对所述坐标数据队列中的路径的坐标点两两遍历计算路径中离散点坐标的最小直线距离;若两条路径中存在路径的坐标点之间的最小距离小于预设阈值,则将所述两条路径标记为连通路径并保存至虚拟主航道的坐标数据队列;若存在某条路径的所有坐标点与任一路径的坐标点之间的最小距离均大于预设阈值,则舍弃该路径的坐标数据;
返航功能启动单元,用于根据返航指令或预设的返航条件控制无人船返航;
船体航行控制单元,用于使所述无人船从当前位置航行至所述虚拟主航道;
最短路径获取单元,用于计算基于所述虚拟主航道的最短返航路径;
所述计算基于所述虚拟主航道的最短返航路径的步骤包括:获取所述虚拟主航道的路径的坐标点并构建坐标数据队列,对所述坐标数据队列中的路径的坐标点两两遍历,获得当前路径的每个坐标点与其它路径的坐标点一一对应的对应关系集合;判断所述对应关系集合中坐标点的距离是否小于最小距离阈值,若小于,则将所述对应关系集合中坐标点保存至映射集合;添加所述无人船的当前实时位置和目标返航位置的坐标至所述映射集合,利用动态规划算法计算所述映射集合中到达目标返航位置的最短连接,得到基于所述虚拟主航道的最短返航路径;
返航功能执行单元,用于将所述最短返航路径设定为无人船的返航路径,所述无人船自主航行实现返航。
6.一种计算机设备,其特征在于,所述计算机设备包括存储器及处理器,所述存储器上存储有计算机程序,所述处理器执行所述计算机程序时实现如权利要求1-4中任一项所述的基于虚拟航道的无人船返航方法。
7.一种存储介质,其特征在于,所述存储介质存储有计算机程序,所述计算机程序包括程序指令,所述程序指令当被处理器执行时可实现如权利要求1-4中任一项所述的基于虚拟航道的无人船返航方法。
Priority Applications (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010702367.3A CN111665868B (zh) | 2020-07-21 | 2020-07-21 | 基于虚拟航道的无人船返航方法、装置、设备及存储介质 |
Applications Claiming Priority (1)
Application Number | Priority Date | Filing Date | Title |
---|---|---|---|
CN202010702367.3A CN111665868B (zh) | 2020-07-21 | 2020-07-21 | 基于虚拟航道的无人船返航方法、装置、设备及存储介质 |
Publications (2)
Publication Number | Publication Date |
---|---|
CN111665868A CN111665868A (zh) | 2020-09-15 |
CN111665868B true CN111665868B (zh) | 2023-06-13 |
Family
ID=72392307
Family Applications (1)
Application Number | Title | Priority Date | Filing Date |
---|---|---|---|
CN202010702367.3A Active CN111665868B (zh) | 2020-07-21 | 2020-07-21 | 基于虚拟航道的无人船返航方法、装置、设备及存储介质 |
Country Status (1)
Country | Link |
---|---|
CN (1) | CN111665868B (zh) |
Families Citing this family (4)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN113238556A (zh) * | 2021-05-14 | 2021-08-10 | 西北工业大学 | 一种基于虚拟现实的水面无人船控制系统及方法 |
CN113867353A (zh) * | 2021-10-08 | 2021-12-31 | 徐州徐工环境技术有限公司 | 一种清扫机器人的自动回程路径规划方法 |
CN114326787A (zh) * | 2021-12-03 | 2022-04-12 | 彩虹无人机科技有限公司 | 一种无人机自主返航航路规划方法、电子设备和介质 |
CN116382305B (zh) * | 2023-06-02 | 2023-08-08 | 陕西欧卡电子智能科技有限公司 | 无人船的曲线倒库方法、系统、计算机设备及存储介质 |
Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107436600A (zh) * | 2017-01-24 | 2017-12-05 | 安徽科微智能科技有限公司 | 一种无人船多航点返航控制系统 |
CN108124471A (zh) * | 2017-12-11 | 2018-06-05 | 深圳市道通智能航空技术有限公司 | 无人飞行器返航方法、装置、存储介质和无人飞行器 |
CN109857135A (zh) * | 2017-11-30 | 2019-06-07 | 深圳市科比特航空科技有限公司 | 一种无人机控制方法、装置、终端设备及存储介质 |
CN109993994A (zh) * | 2017-12-29 | 2019-07-09 | 浙江省测绘科学技术研究院 | 一种航线分割方法及装置 |
CN110687923A (zh) * | 2019-11-08 | 2020-01-14 | 深圳市道通智能航空技术有限公司 | 无人机长距离循迹飞行方法、装置、设备及存储介质 |
CN110955245A (zh) * | 2019-12-09 | 2020-04-03 | 深圳市银星智能科技股份有限公司 | 路径追踪方法、装置、移动机器人及非暂态计算机可读存储介质 |
Family Cites Families (1)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
EP3298555A1 (en) * | 2015-05-19 | 2018-03-28 | Fleetmatics Ireland Limited | System and method for accelerating route search |
-
2020
- 2020-07-21 CN CN202010702367.3A patent/CN111665868B/zh active Active
Patent Citations (6)
Publication number | Priority date | Publication date | Assignee | Title |
---|---|---|---|---|
CN107436600A (zh) * | 2017-01-24 | 2017-12-05 | 安徽科微智能科技有限公司 | 一种无人船多航点返航控制系统 |
CN109857135A (zh) * | 2017-11-30 | 2019-06-07 | 深圳市科比特航空科技有限公司 | 一种无人机控制方法、装置、终端设备及存储介质 |
CN108124471A (zh) * | 2017-12-11 | 2018-06-05 | 深圳市道通智能航空技术有限公司 | 无人飞行器返航方法、装置、存储介质和无人飞行器 |
CN109993994A (zh) * | 2017-12-29 | 2019-07-09 | 浙江省测绘科学技术研究院 | 一种航线分割方法及装置 |
CN110687923A (zh) * | 2019-11-08 | 2020-01-14 | 深圳市道通智能航空技术有限公司 | 无人机长距离循迹飞行方法、装置、设备及存储介质 |
CN110955245A (zh) * | 2019-12-09 | 2020-04-03 | 深圳市银星智能科技股份有限公司 | 路径追踪方法、装置、移动机器人及非暂态计算机可读存储介质 |
Non-Patent Citations (1)
Title |
---|
施工水域中船舶航行路径规划研究;曾黎;《中国优秀硕士学位论文全文数据库 工程科技Ⅱ辑》;20200615;全文 * |
Also Published As
Publication number | Publication date |
---|---|
CN111665868A (zh) | 2020-09-15 |
Similar Documents
Publication | Publication Date | Title |
---|---|---|
CN111665868B (zh) | 基于虚拟航道的无人船返航方法、装置、设备及存储介质 | |
CN110260867B (zh) | 一种机器人导航中位姿确定、纠正的方法、设备及装置 | |
JP6427908B2 (ja) | 地図情報生成システム、方法およびプログラム | |
KR101335592B1 (ko) | 환경 및 이동 유닛의 스캔들의 비교에 의한 이동 유닛의 상대적 위치 결정 방법 | |
KR101831264B1 (ko) | 조종가능 플랫폼용의 자율 항해 시스템 및 방법 | |
US10386840B2 (en) | Cruise control system and method | |
CN110986920B (zh) | 定位导航方法、装置、设备及存储介质 | |
CN111694356A (zh) | 一种行驶控制方法、装置、电子设备及存储介质 | |
JP6779356B2 (ja) | 海洋船舶のための近接感知システム及び方法 | |
AU2021205099B2 (en) | Systems and associated methods for generating navigation charts and navigable routes in an open environment | |
KR101907268B1 (ko) | 경로 선택에 기반한 자율 주행 방법 및 장치 | |
JP6801269B2 (ja) | 自律移動装置 | |
CN114879660B (zh) | 一种基于目标驱动的机器人环境感知方法 | |
JP2007249631A (ja) | 折線追従移動ロボットおよび折線追従移動ロボットの制御方法 | |
JP2017151499A (ja) | 障害物回避方法および装置 | |
CN114077249B (zh) | 一种作业方法、作业设备、装置、存储介质 | |
CN112345798B (zh) | 位置姿势推定装置以及位置姿势推定方法 | |
JP6984739B2 (ja) | 捜索支援装置、捜索支援方法、及びプログラム | |
JP6680319B2 (ja) | 地図情報生成システム、方法およびプログラム | |
US11675348B2 (en) | Mission plan paths for multi-domain assets | |
CN112925321B (zh) | 基于人工势场法的船舶路径规划方法、装置和存储介质 | |
JP2022123401A (ja) | 経路計画装置、移動体、経路計画方法及びプログラム | |
JP2019148456A (ja) | 算出装置、自己位置算出方法、およびプログラム | |
CN113320543B (zh) | 行车方法、装置、车辆及存储介质 | |
CN116578098B (zh) | 一种自适应学习的无人艇控制方法及系统 |
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 | ||
GR01 | Patent grant | ||
GR01 | Patent grant |